JP6922613B2 - Forklift cargo handling control method and forklift cargo handling control device - Google Patents
Forklift cargo handling control method and forklift cargo handling control device Download PDFInfo
- Publication number
- JP6922613B2 JP6922613B2 JP2017186621A JP2017186621A JP6922613B2 JP 6922613 B2 JP6922613 B2 JP 6922613B2 JP 2017186621 A JP2017186621 A JP 2017186621A JP 2017186621 A JP2017186621 A JP 2017186621A JP 6922613 B2 JP6922613 B2 JP 6922613B2
- Authority
- JP
- Japan
- Prior art keywords
- shift
- fork
- angle
- state
- current
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims description 131
- 238000006243 chemical reaction Methods 0.000 claims description 69
- 230000001360 synchronised effect Effects 0.000 claims description 35
- 238000013459 approach Methods 0.000 claims description 23
- 238000001514 detection method Methods 0.000 claims description 20
- 238000012790 confirmation Methods 0.000 claims description 7
- 230000003028 elevating effect Effects 0.000 description 23
- 230000007935 neutral effect Effects 0.000 description 19
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 5
- 230000012447 hatching Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 230000000881 depressing effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
Images
Landscapes
- Forklifts And Lifting Vehicles (AREA)
Description
本発明は、車体に対してフォークを左右に移動させることと、上から見た際に車体に対してフォークを左右に旋回させることが可能なフォークリフトを対象とした、フォークリフトの荷役制御方法及びフォークリフトの荷役制御装置に関する。 The present invention is a forklift cargo handling control method and a forklift for a forklift capable of moving the fork left and right with respect to the vehicle body and turning the fork left and right with respect to the vehicle body when viewed from above. Regarding the cargo handling control device.
近年の倉庫には、倉庫内の空間を有効利用するために、フォークリフトの車幅よりも少しだけ広い幅を有する通路を設け、当該通路の左右に沿って積み上げられたラックに荷物が収容されている倉庫がある。当該倉庫では、荷物の入庫や出庫を行う場合、左右の移動と左右の旋回が可能なフォークを備えたフォークリフトを用いている。なお、フォークの旋回中心軸はフォークの後端の側にあるので、旋回させた方向にフォークの先端が突出する。従って、通路の幅内においてフォークの左右方向の位置を固定した状態でフォークを右旋回または左旋回させた場合、左右のラックにフォークが接触する場合がある。このフォークの接触を回避するためには、フォークの左右の旋回と左右の移動とを同時に行う必要がある。例えば、通路内においてラックに接触させることなくフォークの先端を右に向けたい場合は、フォークを右に旋回させながら、フォークがラックに接触しないようにフォークを左に移動させる必要がある。フォークリフトのオペレータが、マニュアル操作にて、フォークをラックに接触させないように、フォークを右(または左)に旋回させながら、フォークを左(または右)へと同期させて移動させることは、困難であり、手間もかかる。そこで、フォークが車体の左右からはみ出さないように、自動的にフォークを右(または左)に旋回させながら、フォークを左(または右)へと同期させて移動させる、種々の自動同期制御が開示されている。 In recent years, warehouses are provided with aisles that are slightly wider than the width of forklift trucks in order to make effective use of the space inside the warehouse, and luggage is stored in racks stacked along the left and right sides of the aisles. There is a warehouse. The warehouse uses a forklift equipped with a fork that can move left and right and turn left and right when loading and unloading luggage. Since the turning center axis of the fork is on the rear end side of the fork, the tip of the fork protrudes in the turning direction. Therefore, when the fork is turned right or left while the position of the fork in the left-right direction is fixed within the width of the aisle, the fork may come into contact with the left and right racks. In order to avoid this contact of the fork, it is necessary to turn the fork left and right and move it left and right at the same time. For example, if you want to turn the tip of the fork to the right in the aisle without touching the rack, you need to turn the fork to the right and move the fork to the left so that the fork does not touch the rack. It is difficult for a forklift operator to manually move the fork in synchronization with the left (or right) while turning the fork to the right (or left) so that the fork does not come into contact with the rack. Yes, it takes time and effort. Therefore, various automatic synchronization controls that automatically rotate the fork to the right (or left) and move the fork in synchronization with the left (or right) so that the fork does not protrude from the left and right of the vehicle body. It is disclosed.
なお、以降では、上から見た際の車体に対するフォークの旋回角度をローテート角度、車体の左右方向におけるフォークの位置をシフト位置、とする。また、フォークを右移動させた際のシフト位置の限界である右シフト限界位置、かつフォークを左旋回させた際にフォークが車体の前進方向に対して直交する左方向を向いたローテート角度である左向き角度、となるシフト位置及びローテート角度のフォークを右ホームポジションとする(図7参照)。また、フォークを左移動させた際のシフト位置の限界である左シフト限界位置、かつフォークを右旋回させた際にフォークが車体の前進方向に対して直交する右方向を向いたローテート角度である右向き角度、となるシフト位置及びローテート角度のフォークを左ホームポジションとする(図5参照)。 Hereinafter, the turning angle of the fork with respect to the vehicle body when viewed from above is referred to as the rotate angle, and the position of the fork in the left-right direction of the vehicle body is referred to as the shift position. Further, it is the right shift limit position which is the limit of the shift position when the fork is moved to the right, and the rotation angle when the fork is oriented to the left orthogonal to the forward direction of the vehicle body when the fork is turned to the left. The fork at the shift position and the rotate angle, which is the leftward angle, is set as the right home position (see FIG. 7). Also, at the left shift limit position, which is the limit of the shift position when the fork is moved to the left, and at the rotation angle where the fork faces the right direction orthogonal to the forward direction of the vehicle body when the fork is turned to the right. The fork at the shift position and the rotate angle, which is a certain rightward angle, is set as the left home position (see FIG. 5).
例えば特許文献1のフォークリフトのフォーク自動反転制御装置には、図20に示す相対位置関係カーブが記載されている。図20に示す相対位置関係カーブでは、横軸はフォークのローテート角度Rを示しており、右端のローテート角度ではフォークが左向き(左向き角度に相当)、左端のローテート角度ではフォークが右向き(右向き角度に相当)、の状態であることを示している。また当該相対位置関係カーブでは、縦軸はフォークのシフト位置Mを示しており、下端ではフォークのシフト位置が左端(左シフト限界位置に相当)、上端ではフォークのシフト位置が右端(右シフト限界位置に相当)、であることを示している。また、斜線ハッチング部分は、フォークがラックと干渉する干渉領域Rcを示しており、中央線Cは、干渉領域Rcの限界線(境界線)Lc1、Lc2の中央となる曲線を複数の直線で近似した線である。また、干渉領域Rcでない領域である非干渉領域NRc内において、中央線Cを含んで非干渉領域NRcを更に狭くした、縦線ハッチングで示す許容領域Rfが設定されている。なお、図20中において、干渉領域Rcでない領域、かつ、許容領域Rfでない領域(図20中において、斜線ハッチングも縦線ハッチングも施されていない領域)、を非許容領域NRfとする。
For example, the fork automatic inversion control device for a forklift of
引用文献1では、フォーク状態(ローテート角度、シフト位置)が、図20中における許容領域Rf内の場合、シフト動作とローテート動作の同期制御を実行可能である。また、同期操作を実行する際、オペレータは、ボタンを操作し、かつローテートレバーを操作することで、同期動作を指示する。また、フォーク状態(ローテート角度、シフト位置)が、図20中における非許容領域NRf内の場合(例えば図20中のP1(R1、M1)等の場合)、フォーク状態(ローテート角度、シフト位置)に応じて、ローテート動作またはシフト動作の一方を行って、フォーク状態(ローテート角度、シフト位置)を、非許容領域NRfから許容領域Rfへと旋回・移動させ、許容領域Rf内に入った後は、シフト動作とローテート動作の同期制御へ移行している。なお、フォーク状態(ローテート角度、シフト位置)が干渉領域Rc内にある場合では、エラーを表示手段に表示して、フォークの制御を停止している。なお、通常の搬入・搬出作業(荷役作業)は、フォークのローテート角度を、フォークリフトの前進方向に直交する右向き角度または左向き角度にして、フォークを左右にシフト動作させる。従って、フォークのローテート角度が、フォークリフトの前進方向に直交する右向き角度または左向き角度の場合は、干渉領域Rc内であってもシフト動作は可能とされている。
In
左ラックと右ラックに挟まれた通路内に入ったフォークリフトは、左ラックに対して荷役作業を行う際、左に向けたフォークを左シフト動作させて干渉領域Rc内にフォークの先端を差し込んで荷物の搬入や搬出を行う。同様に、通路内に入ったフォークリフトは、右ラックに対して荷役作業を行う際、右に向けたフォークを右シフト動作させて干渉領域Rc内にフォークの先端を差し込んで荷物の搬入や搬出を行う。特許文献1に記載のフォークリフトのフォーク自動反転制御装置では、例えば、搬入または搬出中に、オペレータが、うっかりローテートレバーを操作すると、干渉領域Rc内でフォークの動作が停止し、干渉領域Rc内のフォークの制御ができなくなる可能性があるので好ましくない。
The forklift that entered the aisle between the left rack and the right rack inserts the tip of the fork into the interference area Rc by shifting the fork to the left to the left when performing cargo handling work on the left rack. Carry in and out of luggage. Similarly, when performing cargo handling work on the right rack, the forklift that has entered the aisle shifts the fork to the right to the right and inserts the tip of the fork into the interference area Rc to carry in and out the luggage. conduct. In the fork automatic reversing control device of the forklift described in
本発明は、このような点に鑑みて創案されたものであり、フォークを右向きまたは左向きにして左右にシフト動作させる搬入時・搬出時(荷役作業時)を除き、フォークが干渉領域(禁止領域)内に入っている場合、安全に干渉領域(禁止領域)から脱出できるように支援する、フォークリフトの荷役制御方法及びフォークリフトの荷役制御装置を提供することを課題とする。 The present invention was devised in view of these points, and the fork is in an interference region (prohibited region) except during loading and unloading (during cargo handling work) in which the fork is shifted to the right or left and shifted to the left or right. ), It is an object of the present invention to provide a forklift cargo handling control method and a forklift cargo handling control device that assist in safely escaping from the interference area (prohibited area).
上記課題を解決するため、本発明の第1の発明は、車体に対してフォークを右移動させる右シフト動作、及び車体に対して前記フォークを左移動させる左シフト動作、を行うシフト駆動装置と、車体に対して前記フォークを右回りに旋回させる右ローテート動作、及び車体に対して前記フォークを左回りに旋回させる左ローテート動作、を行うローテート駆動装置と、操作手段と、前記操作手段の操作状態に応じて、前記シフト駆動装置と前記ローテート駆動装置を制御する制御装置と、記憶装置と、を用いた、フォークリフトの荷役制御方法である。また、車体に対する前記フォークの旋回角度をローテート角度、車体の左右方向における前記フォークの位置をシフト位置、前記フォークを右移動させた際のシフト位置の限界である右シフト限界位置、かつ前記フォークを左旋回させた際に前記フォークが車体の前進方向に対して直交する左方向を向いたローテート角度である左向き角度、となるシフト位置及びローテート角度の前記フォークの状態を右ホームポジション、前記フォークを左移動させた際のシフト位置の限界である左シフト限界位置、かつ前記フォークを右旋回させた際に前記フォークが車体の前進方向に対して直交する右方向を向いたローテート角度である右向き角度、となるシフト位置及びローテート角度の前記フォークの状態を左ホームポジション、とした場合、前記右ホームポジションから前記左ホームポジションへと前記左シフト動作を行いながら前記右ローテート動作を同期させた際、あるいは、前記左ホームポジションから前記右ホームポジションへと前記右シフト動作を行いながら前記左ローテート動作を同期させた際、におけるローテート角度に対応させて、シフト位置に関連するシフト関連量が設定されているとともに、前記フォークが車体の幅よりも左右に突出するローテート角度及びシフト関連量となる領域が禁止領域として設定された、同期基準特性を予め前記記憶装置に記憶しておく。そして、前記操作手段が操作されて、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、が入力された場合に、前記制御装置にて、現在の前記フォークのローテート角度である現在ローテート角度と、現在の前記フォークのシフト位置に対応するシフト関連量である現在シフト関連量と、に基づいた現在のフォークの状態である現在フォーク状態が、前記同期基準特性における前記禁止領域内であるか否かを判定する、禁止領域内確認ステップと、前記現在フォーク状態が前記禁止領域内であると判定した場合、前記ローテート駆動装置の制御を禁止する、ローテート動作禁止ステップと、を有する、フォークリフトの荷役制御方法である。 In order to solve the above problems, the first invention of the present invention is a shift drive device that performs a right shift operation for moving the fork to the right with respect to the vehicle body and a left shift operation for moving the fork to the left with respect to the vehicle body. A rotate drive device that performs a right-handed rotation operation of turning the fork clockwise with respect to the vehicle body and a left-rotating operation of turning the fork counterclockwise with respect to the vehicle body, an operating means, and an operation of the operating means. This is a cargo handling control method for a forklift using a control device for controlling the shift drive device, the rotate drive device, and a storage device according to a state. Further, the turning angle of the fork with respect to the vehicle body is the rotate angle, the position of the fork in the left-right direction of the vehicle body is the shift position, the right shift limit position which is the limit of the shift position when the fork is moved to the right, and the fork. When the fork is turned to the left, the state of the fork at the shift position and the rotate angle, which is the leftward angle, which is the rotation angle at which the fork faces the left direction orthogonal to the forward direction of the vehicle body, is the right home position, and the fork is The left shift limit position, which is the limit of the shift position when the fork is moved to the left, and the rightward rotation angle, which is the rotation angle at which the fork faces the right direction orthogonal to the forward direction of the vehicle body when the fork is turned to the right. When the state of the fork at the shift position and the rotate angle, which is the angle, is the left home position, the right rotate operation is synchronized while performing the left shift operation from the right home position to the left home position. Alternatively, when the left rotation operation is synchronized while performing the right shift operation from the left home position to the right home position, a shift-related amount related to the shift position is set corresponding to the rotation angle in. In addition, the synchronization reference characteristic in which the rotation angle at which the fork protrudes to the left and right from the width of the vehicle body and the region serving as the shift-related amount is set as the prohibited region is stored in advance in the storage device. Then, when the operating means is operated and a right home position instruction for setting the fork state to the right home position or a left home position instruction for setting the fork state to the left home position is input. In the state of the current fork based on the current rotation angle, which is the current rotation angle of the fork, and the current shift-related amount, which is the shift-related amount corresponding to the current shift position of the fork, in the control device. A prohibited area confirmation step for determining whether or not a certain current fork state is within the prohibited area in the synchronization reference characteristic, and when it is determined that the current fork state is within the prohibited area, the rotate drive It is a cargo handling control method for a forklift having a rotate operation prohibition step for prohibiting control of the device.
次に、本発明の第2の発明は、上記第1の発明に係るフォークリフトの荷役制御方法であって、前記制御装置にて、前記禁止領域内確認ステップにて前記現在フォーク状態が前記禁止領域内であると判定した場合、前記操作手段の操作状態に基づいて求めた目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向であると判定した場合は、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御し、前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向でないと判定した場合は、前記シフト駆動装置のフィードバック制御を中止する、禁止領域脱出シフト制御ステップを有する、フォークリフトの荷役制御方法である。 Next, the second invention of the present invention is the forklift cargo handling control method according to the first invention, in which the current fork state is changed to the prohibited area in the prohibited area confirmation step in the control device. If it is determined that the speed is within, the direction of the shift operation toward the target shift-related amount obtained based on the operating state of the operating means is the direction of escaping from the prohibited area, the current shift-related amount is determined. When the shift drive device is feedback-controlled so that the amount approaches the target shift-related amount and it is determined that the direction of the shift operation toward the target shift-related amount is not the direction of escaping from the prohibited region, the shift drive is performed. It is a cargo handling control method of a forklift having a prohibited area escape shift control step that stops the feedback control of the device.
次に、本発明の第3の発明は、上記第2の発明に係るフォークリフトの荷役制御方法であって、前記制御装置にて、前記禁止領域脱出シフト制御ステップを実行した後、前記禁止領域内確認ステップにて前記現在フォーク状態が、前記禁止領域内でないと判定した場合に、前記現在ローテート角度、あるいは前記同期基準特性と前記現在シフト関連量に基づいて求めたローテート角度である同期ローテート角度に、前記操作手段の操作状態に基づいて求めた加算ローテート角度を加算した目標ローテート角度を求める、目標ローテート角度算出ステップと、前記現在ローテート角度が前記目標ローテート角度に近づくように前記ローテート駆動装置をフィードバック制御する、ローテートフィードバック制御ステップと、前記同期基準特性と前記現在ローテート角度に基づいて求めたシフト関連量である同期シフト関連量、あるいは前記現在シフト関連量に、前記操作手段の操作状態に基づいて求めた加算シフト関連量を加算した目標シフト関連量を求める、目標シフト関連量算出ステップと、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御する、シフトフィードバック制御ステップと、を有する、フォークリフトの荷役制御方法である。 Next, the third invention of the present invention is the cargo handling control method of the forklift according to the second invention, and after executing the prohibited area escape shift control step in the control device, the inside of the prohibited area When it is determined in the confirmation step that the current fork state is not within the prohibited region, the current rotation angle or the synchronization rotation angle, which is a rotation angle obtained based on the synchronization reference characteristic and the current shift-related amount, is obtained. A target rotation angle calculation step of obtaining a target rotation angle obtained by adding an additional rotation angle obtained based on the operating state of the operating means, and feeding back the rotation driving device so that the current rotation angle approaches the target rotation angle. The rotate feedback control step to be controlled, the synchronous shift-related amount which is the shift-related amount obtained based on the synchronization reference characteristic and the current rotation angle, or the current shift-related amount, based on the operating state of the operating means. A target shift-related amount calculation step for obtaining a target shift-related amount by adding the obtained addition shift-related amount, and a shift feedback that feedback-controls the shift drive device so that the current shift-related amount approaches the target shift-related amount. It is a cargo handling control method of a forklift having a control step.
次に、本発明の第4の発明は、上記第1の発明〜第3の発明のいずれか1つに係るフォークリフトの荷役制御方法であって、前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、前記フォークの向きを車体の前進方向とした場合のローテート角度を0°、前記フォークの向きを前記左向き角度とした場合のローテート角度を−90°、前記フォークの向きを前記右向き角度とした場合のローテート角度を+90°、と設定する。また、前記シフト関連量には、シフト位置を角度に換算した換算角度を設定し、前記左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置を、換算角度0°、前記右シフト限界位置となるシフト位置を、換算角度+90°、前記左シフト限界位置となるシフト位置を、換算角度−90°、と設定し、前記左シフト限界位置から前記右シフト限界位置に至るまでの各シフト位置を、換算角度−90°から換算角度+90°の範囲内において対応する換算角度に設定する、フォークリフトの荷役制御方法である。 Next, the fourth invention of the present invention is a forklift cargo handling control method according to any one of the first to third inventions, wherein the fork is from the leftward angle to the rightward angle. The right rotation operation is possible, the left rotation operation is possible from the right angle to the left angle, and the right shift operation is possible from the left shift limit position to the right shift limit position. The left shift operation is possible from the right shift limit position to the left shift limit position, the rotation angle is 0 ° when the fork direction is the forward direction of the vehicle body, and the fork direction is the left direction angle. The rotation angle is set to −90 °, and the rotation angle when the fork is oriented to the right is set to + 90 °. Further, a conversion angle obtained by converting the shift position into an angle is set for the shift-related amount, and the central shift position from the left shift limit position to the right shift limit position is set to a conversion angle of 0 ° and the right shift. The shift position that becomes the limit position is set as a conversion angle + 90 °, and the shift position that becomes the left shift limit position is set as a conversion angle -90 °, and each from the left shift limit position to the right shift limit position. This is a cargo handling control method for a forklift that sets the shift position to the corresponding conversion angle within the range of the conversion angle −90 ° to the conversion angle +90 °.
次に、本発明の第5の発明は、車体に対してフォークを右移動させる右シフト動作、及び車体に対して前記フォークを左移動させる左シフト動作、を行うシフト駆動装置と、車体に対して前記フォークを右回りに旋回させる右ローテート動作、及び車体に対して前記フォークを左回りに旋回させる左ローテート動作、を行うローテート駆動装置と、車体に対する前記フォークの旋回角度であるローテート角度を検出するローテート角度検出手段と、車体の左右方向における前記フォークの位置であるシフト位置を検出するシフト位置検出手段と、操作手段と、前記操作手段の操作状態を検出する操作状態検出手段と、を有するフォークリフトにおける前記右シフト動作、前記左シフト動作、前記右ローテート動作、前記左ローテート動作を制御する、フォークリフトの荷役制御装置であって、記憶装置と、制御装置と、を有する。また、前記フォークを右移動させた際のシフト位置の限界である右シフト限界位置、かつ前記フォークを左旋回させた際に前記フォークが車体の前進方向に対して直交する左方向を向いたローテート角度である左向き角度、となるシフト位置及びローテート角度の前記フォークの状態を右ホームポジション、前記フォークを左移動させた際のシフト位置の限界である左シフト限界位置、かつ前記フォークを右旋回させた際に前記フォークが車体の前進方向に対して直交する右方向を向いたローテート角度である右向き角度、となるシフト位置及びローテート角度の前記フォークの状態を左ホームポジション、とした場合、前記記憶装置には、前記右ホームポジションから前記左ホームポジションへと前記左シフト動作を行いながら前記右ローテート動作を同期させた際、あるいは、前記左ホームポジションから前記右ホームポジションへと前記右シフト動作を行いながら前記左ローテート動作を同期させた際、におけるローテート角度に対応させて、シフト位置に関連するシフト関連量が設定されているとともに、前記フォークが車体の幅よりも左右に突出するローテート角度及びシフト関連量となる領域が禁止領域として設定された、同期基準特性が記憶されている。そして、前記制御装置は、前記操作状態検出手段からの検出信号に基づいて、前記操作手段の操作状態である操作手段操作状態を検出し、前記ローテート角度検出手段からの検出信号に基づいて、現在の前記フォークのローテート角度である現在ローテート角度を求め、前記シフト位置検出手段からの検出信号に基づいて、現在の前記フォークのシフト位置に対応するシフト関連量を求め、前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、現在の前記フォークのローテート角度である現在ローテート角度と、現在の前記フォークのシフト位置に対応するシフト関連量である現在シフト関連量と、に基づいた現在のフォークの状態である現在フォーク状態が、前記同期基準特性における前記禁止領域内であるか否かを判定し、前記現在フォーク状態が前記禁止領域内であると判定した場合、前記ローテート駆動装置の制御を禁止する、フォークリフトの荷役制御装置である。 Next, a fifth aspect of the present invention is a shift drive device that performs a right shift operation for moving the fork to the right with respect to the vehicle body and a left shift operation for moving the fork to the left with respect to the vehicle body, and a vehicle body. A rotate drive device that performs a right-handed rotation operation of turning the fork clockwise and a left-handed rotation operation of turning the fork counterclockwise with respect to the vehicle body, and a rotation angle which is a turning angle of the fork with respect to the vehicle body is detected. It has a rotate angle detecting means for detecting a shift position which is a position of the fork in the left-right direction of the vehicle body, an operating means, and an operating state detecting means for detecting the operating state of the operating means. A cargo handling control device for a forklift that controls the right shift operation, the left shift operation, the right rotate operation, and the left rotate operation in the forklift, and includes a storage device and a control device. Further, the rotation is at the right shift limit position, which is the limit of the shift position when the fork is moved to the right, and when the fork is turned to the left, the fork faces the left direction orthogonal to the forward direction of the vehicle body. The state of the fork at the shift position and the rotate angle, which is an angle to the left, is the right home position, the left shift limit position which is the limit of the shift position when the fork is moved to the left, and the fork is turned to the right. When the state of the fork at the shift position and the rotate angle, which is the rightward angle, which is the rotation angle at which the fork faces the right direction orthogonal to the forward direction of the vehicle body when the fork is moved, is the left home position, the above. In the storage device, when the right rotate operation is synchronized while performing the left shift operation from the right home position to the left home position, or the right shift operation from the left home position to the right home position. When the left rotation operation is synchronized while performing the above, the shift-related amount related to the shift position is set corresponding to the rotation angle in, and the rotation angle at which the fork protrudes to the left and right from the width of the vehicle body. And the synchronization reference characteristic in which the shift-related amount area is set as the prohibited area is stored. Then, the control device detects the operating state of the operating means, which is the operating state of the operating means, based on the detection signal from the operating state detecting means, and is currently based on the detection signal from the rotate angle detecting means. The current rotation angle, which is the rotation angle of the fork, is obtained, and the shift-related amount corresponding to the current shift position of the fork is obtained based on the detection signal from the shift position detecting means. When the right home position instruction for setting the fork state to the right home position or the left home position instruction for setting the fork state to the left home position, the current rotation angle which is the current rotation angle of the fork and the current rotation angle. Whether or not the current shift-related amount, which is the shift-related amount corresponding to the current shift position of the fork, and the current fork state, which is the current fork state based on, are within the prohibited region in the synchronization reference characteristic. This is a forklift cargo handling control device that prohibits control of the rotate drive device when it is determined that the current fork state is within the prohibited area.
次に、本発明の第6の発明は、上記第5の発明に係るフォークリフトの荷役制御装置であって、前記制御装置は、前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、前記現在フォーク状態が前記禁止領域内であると判定した際、前記操作手段操作状態に基づいて目標シフト関連量を求め、求めた前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向であると判定した場合は、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御し、前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向でないと判定した場合は、前記シフト駆動装置のフィードバック制御を中止する、フォークリフトの荷役制御装置である。 Next, the sixth invention of the present invention is the forklift cargo handling control device according to the fifth invention, in which the operating means operating state changes the fork state to the right home position. In the case of a right home position instruction or a left home position instruction that changes the state of the fork to the left home position, when it is determined that the current fork state is within the prohibited area, the operation means is based on the operation state. When the target shift-related amount is obtained and it is determined that the direction of the shift operation toward the obtained target shift-related amount is the direction of escaping from the prohibited area, the current shift-related amount becomes the target shift-related amount. The shift drive device is feedback-controlled so as to approach the target shift drive device, and when it is determined that the direction of the shift operation toward the target shift-related amount is not the direction of escaping from the prohibited area, the feedback control of the shift drive device is stopped. It is a cargo handling control device for forklifts.
次に、本発明の第7の発明は、上記第6の発明に係るフォークリフトの荷役制御装置であって、前記制御装置は、前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、前記現在フォーク状態が前記禁止領域内でないと判定した際、前記現在ローテート角度、あるいは前記同期基準特性と前記現在シフト関連量に基づいて求めたローテート角度である同期ローテート角度に、前記操作手段操作状態に基づいて求めた加算ローテート角度を加算した目標ローテート角度を求め、前記現在ローテート角度が前記目標ローテート角度に近づくように前記ローテート駆動装置をフィードバック制御し、前記同期基準特性と前記現在ローテート角度に基づいて求めたシフト関連量である同期シフト関連量、あるいは前記現在シフト関連量に、前記操作手段操作状態に基づいて求めた加算シフト関連量を加算した目標シフト関連量を求め、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御する、フォークリフトの荷役制御装置である。 Next, a seventh invention of the present invention is a cargo handling control device for a forklift according to the sixth invention, wherein the operating means operating state changes the fork state to the right home position. In the case of a right home position instruction or a left home position instruction that changes the state of the fork to the left home position, when it is determined that the current fork state is not within the prohibited area, the current rotate angle or the synchronization is performed. The target rotation angle is obtained by adding the addition rotation angle obtained based on the operating state of the operating means to the synchronous rotation angle which is the rotation angle obtained based on the reference characteristic and the current shift-related quantity, and the current rotation angle is the said. The rotation drive device is feedback-controlled so as to approach the target rotation angle, and the operation is applied to the synchronization shift-related amount, which is the shift-related amount obtained based on the synchronization reference characteristic and the current rotation angle, or the current shift-related amount. Cargo handling control of a forklift, which obtains a target shift-related amount obtained by adding an additional shift-related amount obtained based on a means operating state, and feedback-controls the shift drive device so that the current shift-related amount approaches the target shift-related amount. It is a device.
次に、本発明の第8の発明は、上記第5の発明〜第7の発明のいずれか1つに係るフォークリフトの荷役制御装置であって、前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、前記フォークの向きを車体の前進方向とした場合のローテート角度は0°、前記フォークの向きを前記左向き角度とした場合のローテート角度は−90°、前記フォークの向きを前記右向き角度とした場合のローテート角度は+90°、と設定されている。また、前記シフト関連量には、シフト位置を角度に換算した換算角度が設定されており、前記左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置は、換算角度0°、前記右シフト限界位置となるシフト位置は、換算角度+90°、前記左シフト限界位置となるシフト位置は、換算角度−90°、と設定されており、前記左シフト限界位置から前記右シフト限界位置に至るまでの各シフト位置は、換算角度−90°から換算角度+90°の範囲内において対応する換算角度に設定されている、フォークリフトの荷役制御装置である。 Next, the eighth invention of the present invention is a forklift cargo handling control device according to any one of the fifth to seventh inventions, wherein the fork is from the leftward angle to the rightward angle. The right rotation operation is possible, the left rotation operation is possible from the right angle to the left angle, and the right shift operation is possible from the left shift limit position to the right shift limit position. The left shift operation is possible from the right shift limit position to the left shift limit position, the rotation angle is 0 ° when the fork direction is the forward direction of the vehicle body, and the fork direction is the left direction angle. The rotation angle is set to −90 °, and the rotation angle is set to + 90 ° when the fork is oriented to the right. Further, a conversion angle obtained by converting the shift position into an angle is set in the shift-related amount, and the central shift position from the left shift limit position to the right shift limit position has a conversion angle of 0 °. The shift position that is the right shift limit position is set to the conversion angle + 90 °, and the shift position that is the left shift limit position is set to the conversion angle -90 °, and the shift position is changed from the left shift limit position to the right shift limit position. Each shift position up to that point is a forklift cargo handling control device set to a corresponding conversion angle within a range of a conversion angle of −90 ° to a conversion angle of +90 °.
第1の発明、第5の発明によれば、現在フォーク状態が禁止領域内に入っている場合、ローテート動作とシフト動作の同期動作を要求する右ホームポジション指示または左ホームポジション指示がオペレータから入力されても、ローテート動作を禁止する(すなわち、シフト動作のみを行う)ことで、安全に干渉領域(禁止領域)から脱出できるように支援することができる。 According to the first and fifth inventions, when the fork state is currently in the prohibited area, the operator inputs a right home position instruction or a left home position instruction requesting synchronous operation of the rotate operation and the shift operation. Even if this is done, by prohibiting the rotate operation (that is, performing only the shift operation), it is possible to support the safe escape from the interference area (prohibited area).
第2の発明、第6の発明によれば、現在フォーク状態が禁止領域内に入っている場合、オペレータから右ホームポジション指示または左ホームポジション指示が入力された際、禁止領域から脱出する方向のシフト動作を許容する。これにより、安全に干渉領域(禁止領域)から脱出できるように支援することができる。 According to the second and sixth inventions, when the fork state is currently in the prohibited area, when the operator inputs a right home position instruction or a left home position instruction, the direction of escaping from the prohibited area is obtained. Allow shift operation. As a result, it is possible to support the safe escape from the interference area (prohibited area).
第3の発明、第7の発明では、禁止領域から無事に脱出した後、オペレータからの右ホームポジション指示または左ホームポジション指示に応じて、ローテート動作とシフト動作の同期動作を行うことができる。つまり、現在フォーク状態が禁止領域内に入っている場合、オペレータは右ホームポジション指示または左ホームポジション指示を継続しているだけで、禁止領域から安全に脱出し(第2発明、第6発明より)、脱出後は自動的にローテート動作とシフト動作の同期動作を行って、右ホームポジションまたは左ホームポジションへとフォークを移動させることができる。 In the third and seventh inventions, after successfully escaping from the prohibited area, the rotation operation and the shift operation can be synchronized with each other in response to the right home position instruction or the left home position instruction from the operator. That is, when the fork state is currently in the prohibited area, the operator can safely escape from the prohibited area simply by continuing the right home position instruction or the left home position instruction (from the second invention and the sixth invention). ), After escaping, the fork can be moved to the right home position or the left home position by automatically synchronizing the rotation operation and the shift operation.
第4の発明、第8の発明によれば、例えば、左シフト限界位置から右シフト限界位置までの距離が、フォークリフト毎に種々の異なる距離であっても、すべて左シフト限界位置は換算角度−90[°]、右シフト限界位置は+90[°]となる。従って、シフト動作の距離の長さの違いにかかわらず、同一の制御プログラムで制御することが可能となるので便利である。 According to the fourth and eighth inventions, for example, even if the distance from the left shift limit position to the right shift limit position is variously different for each forklift, all the left shift limit positions are converted angles-. 90 [°], the right shift limit position is +90 [°]. Therefore, it is convenient because it is possible to control with the same control program regardless of the difference in the length of the shift operation distance.
以下に本発明を実施するための形態を図面を用いて説明する。なお、図中にX軸、Y軸、Z軸が記載されている場合、X軸とY軸とZ軸は互いに直交しており、Z軸は鉛直上方を示し、X軸はフォークリフトの前進方向を示し、Y軸はフォークリフトの左方向を示している。 Hereinafter, embodiments for carrying out the present invention will be described with reference to the drawings. When the X-axis, Y-axis, and Z-axis are described in the figure, the X-axis, the Y-axis, and the Z-axis are orthogonal to each other, the Z-axis indicates vertically upward, and the X-axis is the forward direction of the forklift. The Y-axis indicates the left direction of the forklift.
なお、本実施の形態の説明では、フォークリフト1の運転席のオペレータから見てフォーク35(アーム32)を右移動させる動作を「右シフト動作」、フォークリフト1に対してフォーク35(アーム32)を左移動させる動作を「左シフト動作」、と記載する。また、同様に運転席のオペレータがフォークを上から見た際に、フォークリフト1の車体に対してフォーク35を右回りに旋回させる動作を「右ローテート動作」、フォークリフト1の車体に対してフォーク35を左回りに旋回させる動作を「左ローテート動作」、と記載する。また、「シフト動作」は、右シフト動作と左シフト動作を含み、「ローテート動作」は、右ローテート動作と左ローテート動作を含むものとする。また、同様に運転席のオペレータがフォークを上から見た際の、フォークリフト1に対するフォーク35の旋回角度を「ローテート角度」、フォークリフト1の左右方向におけるフォーク35(アーム32)の位置を「シフト位置」とする。
In the description of the present embodiment, the operation of moving the fork 35 (arm 32) to the right when viewed from the operator of the driver's seat of the
●[フォークリフト1の全体構成(図1〜図8)]
図1〜図3に示すように、本実施の形態にて説明するフォークリフト1は、車体10、マスト20、昇降ユニット30、駆動操舵輪16A、キャスタ輪16B、従動輪16C等を有している。車体10は、ボディ11、リーチレグ12(図4参照)、ヘッドガード13等を有している。なお、本実施の形態の説明では、各モータが、バッテリ50から供給される電力で動作する電動モータである。
● [Overall configuration of forklift 1 (Figs. 1 to 8)]
As shown in FIGS. 1 to 3, the
ボディ11は、図1及び図2に示すように、オペレータが搭乗する床面を有する箱状であり、後方には下方に突出するように駆動操舵輪16A、キャスタ輪16Bが設けられている。またボディ11の左右には、前方に向かって突出するリーチレグ12が左右に一対で設けられており、上方にはヘッドガード13が設けられている。左右のリーチレグ12のそれぞれには、下方に突出するように従動輪16Cが設けられ、左右のリーチレグ12によって板状のクロスプレート17が支持されている。なお、クロスプレート17にはマスト20が設けられている。また、ボディ11の後方の下方側面には、左右に突出するように後方ローラ14(図6参照)が設けられ、リーチレグ12の前方側面には、左右に突出するように前方ローラ15(図6参照)が設けられている。図6に示すように、前方ローラ15と後方ローラ14は、通路幅Lを有する通路T内に入ったフォークリフトが、左右のラックと接触することでフォークリフトを案内する機能を持つ。
As shown in FIGS. 1 and 2, the
ボディ11におけるオペレータが搭乗する位置(運転席)には、図1に示すように、操作レバー41、昇降レバー42、アクセルレバー43、ステアリング45、特殊ボタン44(図3参照)等が設けられており、オペレータがそれらのレバーを操作することにより走行や荷役を行う。なお、操作レバー41が操作手段に該当する。またボディ11の床面には、オペレータが踏み込むことによってブレーキが解除されるいわゆるデッドマンタイプのフットブレーキ(図示省略)等が設けられている。またボディ11内には、バッテリ50、走行モータ16M、機台制御装置40(制御装置に相当)等が収容されている。オペレータは、アクセルレバー43を操作し、フットブレーキを踏み込む(ブレーキを解除する)ことで、駆動操舵輪16Aによるフォークリフト1の前進や後進が可能であり、ステアリング45を操作することで、駆動操舵輪16Aの方向を変更してフォークリフト1の右旋回や左旋回を行うことができる。
As shown in FIG. 1, an
マスト20は、図1に示すように、クロスプレート17に設けられている。またマスト20は、クロスプレート17に接続されたアウタマスト21と、アウタマスト21に対して上下にスライド可能なインナマスト22を有している。インナマスト22には、昇降ユニット30を上下に昇降可能とするリフトシリンダが取り付けられている。昇降ユニット30は、車体に設けられた昇降モータ30Mがオイルポンプを駆動することにより、オイルがリフトシリンダへ供給されることによって昇降する。オペレータは、昇降レバー42を操作することで、昇降ユニット30の昇降を指示することができる。
The
昇降ユニット30は、図1に示すように、インナマスト22に上下動可能に取り付けられており、支持部36、シフトレール31、アーム32、ローテートシャフト33、フィンガーバ34、フォーク35等を有している。シフトレール31は、上下に一対で設けられた左右方向に延びるレールであり、アーム32の左右方向の移動を案内する。またシフトレール31は、支持部36を介してインナマスト22に対して上下に移動可能となるように取り付けられている。アーム32は、シフトレール31に対して左右に移動可能となるように取り付けられており、アーム32の先端には、回転軸線33Z回りに左右に旋回可能なローテートシャフト33が設けられている。そしてローテートシャフト33にはフィンガーバ34が取り付けられており、フィンガーバ34にはフォーク35が取り付けられている。
As shown in FIG. 1, the elevating
アーム32内には、図4に示すように、シフトモータ31M、シフトローラ31R、シフト位置検出手段31S、ローテートモータ33M、ローテート角度検出手段33S等が設けられている。シフトモータ31Mは、シフト駆動装置に相当しており、機台制御装置40からの制御信号に基づいて、ギア等の動力伝達手段を介してシフトローラ31Rを回転させる。シフトローラ31Rはシフトレール31と接触しており、シフトローラ31Rが回転すると、アーム32がシフトレール31に沿って左右に移動する。シフト位置検出手段31Sは、例えば位置センサであり、シフトレール31に対するアーム32の左右方向の位置に応じた検出信号を機台制御装置40に出力する。
As shown in FIG. 4, the
ローテートモータ33Mは、ローテート駆動装置に相当しており、機台制御装置40からの制御信号に基づいて、ギア等の動力伝達手段を介してローテートシャフト33を回転軸線33Z回りに旋回させる。ローテート角度検出手段33Sは、例えば角度センサであり、アーム32に対するローテートシャフト33の旋回角度に応じた検出信号を機台制御装置40に出力する。オペレータは、操作レバー41を左右に傾斜させることで、アーム32を左右にシフト移動させることができる。またオペレータは、操作レバー41を前傾させることで、アーム32及びフォーク35を図5に示す左ホームポジションへと移動させることができる。またオペレータは、操作レバー41を後傾させることで、アーム32及びフォーク35を図7に示す右ホームポジションへと移動させることができる。
The rotate
バッテリ50は、例えば鉛蓄バッテリ(鉛蓄電池)であり、バッテリ50から、各モータや機台制御装置40に電力が供給される。
The
次に図3を用いて、オペレータが操作するレバー等が配置された操作パネルについて説明する。操作パネルには、操作レバー41、昇降レバー42、アクセルレバー43、特殊ボタン44、モニタ47、音声出力装置48、ランプ49等が配置されている。
Next, with reference to FIG. 3, an operation panel on which a lever or the like operated by an operator is arranged will be described. An
操作レバー41は、直立した中立位置に保持されており、中立位置から前後方向へ、あるいは中立位置から左右方向へと傾倒可能とされている。操作レバー41の近傍には、操作状態検出手段41Sが設けられており、機台制御装置40は、操作状態検出手段41Sからの検出信号に基づいて、操作レバー41が、中立位置であるか、前後左右のどの方向に傾倒されているか、傾倒されている場合の操作量(操作角度(=傾倒角度))はどれくらいか、を検出可能である。オペレータが操作レバー41を右に傾倒させると、アーム32が右にシフト移動し、オペレータが操作レバー41を左に傾倒させると、アーム32が左にシフト移動する(図4参照)。
The operating
[左ホームポジション(図5)について]
操作レバー41の前への傾倒は、フォーク35を、図5に示す左ホームポジションへと移動させる左ホームポジション指示であり、左シフト動作と右ローテート動作を同期動作させて左ホームポジションへと移動させる指示である。オペレータが操作レバー41を前に傾倒させると、フォーク35が回転軸線33Z回りに右旋回しながらアーム32が左にシフト移動し、図5に示す左ホームポジション(アーム32が左シフト限界位置、かつ、フォーク35が右向き角度)となる。なお、アーム32の左シフト限界位置は、フォーク35(アーム32)を左シフト動作させた際にシフト位置の限界となる位置(図11の例では、シフト関連量(換算角度)=−90[°]の位置)である。また、フォーク35の右向き角度とは、フォーク35を右ローテート動作させた際に、フォーク35がフォークリフト1の前進方向に対して直交する右方向を向いたローテート角度(図12の例では、ローテート角度=+90[°]の角度)を指す。
[About the left home position (Fig. 5)]
Tilt the operating
[右ホームポジション(図7)について]
操作レバー41の後ろへの傾倒は、フォーク35を、図7に示す右ホームポジションへと移動させる右ホームポジション指示であり、右シフト動作と左ローテート動作を同期動作させて右ホームポジションへと移動させる指示である。オペレータが操作レバー41を後ろに傾倒させると、フォーク35が回転軸線33Z回りに左旋回しながらアーム32が右にシフト移動し、図7に示す右ホームポジション(アーム32が右シフト限界位置、かつ、フォーク35が左向き角度)となる。なお、アーム32の右シフト限界位置は、フォーク35(アーム32)を右シフト動作させた際にシフト位置の限界となる位置(図11の例では、シフト関連量(換算角度)=+90[°]の位置)である。また、フォーク35の左向き角度とは、フォーク35を左ローテート動作させた際に、フォーク35がフォークリフト1の前進方向に対して直交する左方向を向いたローテート角度(図12の例では、ローテート角度=−90[°]の角度)を指す。
[About right home position (Fig. 7)]
Tilt to the rear of the
[中央ホームポジション(図6)について]
また図6は、アーム32が左右方向の中心位置(図11の例では、シフト関連量(換算角度)=0[°]の位置)、かつ、フォーク35が前方を向いた状態(図12の例では、ローテート角度=0[°]の角度)となった、中央ホームポジションを示している。例えばアーム32及びフォーク35が、図5に示す左ホームポジションである場合にオペレータが操作レバー41を後ろに傾倒させると、アーム32が右にシフト移動しながらフォーク35が左に旋回し、アーム32及びフォーク35は、図6に示す中央ホームポジションを経由した後、図7に示す右ホームポジションとなる。なお、オペレータは、フォーク35の旋回動作のみを所望する場合、特殊ボタン44を押しながら操作レバー41を前に傾倒させることで、フォーク35を右旋回させることが可能であり、特殊ボタン44を押しながら操作レバー41を後ろに傾倒させることで、フォーク35を左旋回させることが可能である。
[About the central home position (Fig. 6)]
Further, FIG. 6 shows a state in which the
昇降レバー42は、直立した中立位置に保持されており、中立位置から前後方向へと傾倒可能とされている。昇降レバー42の近傍には、昇降操作状態検出手段42Sが設けられており、機台制御装置40は、昇降操作状態検出手段42Sからの検出信号に基づいて、昇降レバー42が、中立位置であるか、前後のどちらの方向に傾倒されているか、傾倒されている場合の操作量(操作角度)はどれくらいか、を検出可能である。オペレータが昇降レバー42を前に傾倒させると、昇降ユニット30(図1参照)が降下し、オペレータが昇降レバー42を後ろに傾倒させると、昇降ユニット30(図1参照)が上昇する。
The elevating
アクセルレバー43は、直立した中立位置に保持されており、中立位置から前後方向へと傾倒可能とされている。アクセルレバー43の近傍には、アクセル操作状態検出手段43Sが設けられており、機台制御装置40は、アクセル操作状態検出手段43Sからの検出信号に基づいて、アクセルレバー43が、中立位置であるか、前後のどちらの方向に傾倒されているか、傾倒されている場合の操作量(操作角度)はどれくらいか、を検出可能である。オペレータがアクセルレバー43を前に傾倒させると、フォークリフト1が前進し、オペレータがアクセルレバー43を後ろに傾倒させると、フォークリフト1が後退する。
The
モニタ47は、例えば液晶表示装置であり、機台制御装置40からの種々の情報(例えば、バッテリの容量情報)や、警告(例えば、充電の督促)が表示される。音声出力装置48は、例えばスピーカであり、機台制御装置40から種々の警告等を音声で出力する。ランプ49は、例えば複数のLEDランプであり、機台制御装置40から、種々の警告に対応付けられたランプが点灯されたり消灯されたりする。
The
機台制御装置40は、制御装置に相当しており、図8に示すように、シフト位置検出手段31S、ローテート角度検出手段33S、操作状態検出手段41S、昇降操作状態検出手段42S、アクセル操作状態検出手段43S、特殊ボタン44、図示省略した昇降位置検出手段や車速検出手段からの検出信号等が入力される。また機台制御装置40は、図8に示すように、モニタ47(表示装置)、音声出力装置48、ランプ49、シフトモータ31M、ローテートモータ33M、昇降モータ30M、走行モータ16M等を動作させる制御信号を出力する。なお、機台制御装置40は、記憶装置を有している。
The machine
●[第1の実施の形態における機台制御装置40の処理手順(図9〜図17)]
次に図9及び図10に示すフローチャートを用いて、機台制御装置40によるシフトモータ31Mとローテートモータ33Mの制御の処理手順について説明する。なお図9に示すフローチャートは、ステップS515にて現在フォーク状態が禁止領域内に入っていると判定された場合における禁止領域内の処理を示し、図10に示すフローチャートは、ステップS515にて現在フォーク状態が禁止領域内に入っていないと判定された場合(許可領域内と判定した場合)における許可領域内の処理を示している。機台制御装置40は、例えば所定時間間隔(例えば数ms〜数10ms間隔)にて、図9に示す処理を起動し、起動した場合、ステップS510へと処理を進める。
● [Processing procedure of the machine
Next, the processing procedure for controlling the
ステップS510にて、機台制御装置40は、ローテート角度検出手段からの検出信号に基づいて、現在のフォーク35のローテート角度である現在ローテート角度を検出して記憶し、シフト位置検出手段からの検出信号に基づいて、現在のアーム32(フォーク35)のシフト位置である現在シフト位置を検出して記憶する。また、機台制御装置40は、操作レバー41に対応する操作状態検出手段41Sからの検出信号に基づいて、操作レバー41の傾倒方向(前、後、左、右、傾倒なし(中立位置))と操作量(操作角度)を検出して操作手段操作状態として記憶し、特殊ボタン44が押されているか否か(ONとされているか否か)を検出して記憶する。
In step S510, the machine
なお、図12に示すように、フォーク35は、右ホームポジションにて説明した左向き角度から、左ホームポジションにて説明した右向き角度まで、右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能である。そして、図12に示すように、フォーク35の向きを車体の前進方向とした場合のローテート角度を0[°]、フォーク35の向きを前記左向き角度とした場合のローテート角度を−90[°]、フォーク35の向きを前記右向き角度とした場合のローテート角度を+90[°]、と設定する。
As shown in FIG. 12, the
アーム32は、左シフト限界位置(シフトレール31のほぼ左端)から右シフト限界位置(シフトレール31のほぼ右端)の範囲で左右に移動可能である。図11に示すように、シフト関連量には、シフト位置を角度に換算した換算角度を設定する。左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置を換算角度0[°]、右シフト限界位置となるシフト位置を換算角度+90[°]、左シフト限界位置となるシフト位置を換算角度−90[°]、と設定する。そして、左シフト限界位置から右シフト限界位置に至るまでの各シフト位置を、換算角度−90[°]から換算角度+90[°]の範囲内において対応する換算角度に設定する。なお、シフト関連量(換算角度)については、以下に詳細を説明する。
The
[シフト位置をシフト関連量に変換する手順(図11)]
機台制御装置40の記憶装置には、図11に示すシフト位置・換算角度特性が記憶されている。シフト位置・換算角度特性は、横軸がシフト位置、縦軸が換算角度とされており、シフトレールの左端から右端(左シフト限界位置から右シフト限界位置)までの間のシフト位置を、換算角度−90[°]から換算角度+90[°]へと変換するための特性である。図11に示すように、例えば左右方向の長さL1のシフトレールの場合、左右方向の中央位置を換算角度0[°]に設定し、左端位置(左シフト限界位置)を換算角度−90[°]に設定し、右端位置(右シフト限界位置)を換算角度+90[°]に設定する。そして中央位置から左端までの各位置を、位置に応じて0[°]〜−90[°]の換算角度に設定し、中央位置から右端までの各位置を、位置に応じて0[°]〜+90[°]の換算角度に設定する。同様に、例えば左右方向の長さL2のシフトレールの場合、左右方向の中央位置を換算角度0[°]に設定し、左端位置(左シフト限界位置)を換算角度−90[°]に設定し、右端位置(右シフト限界位置)を換算角度+90[°]に設定する。そして中央位置から左端までの各位置を、位置に応じて0[°]〜−90[°]の換算角度に設定し、中央位置から右端までの各位置を、位置に応じて0[°]〜+90[°]の換算角度に設定する。
[Procedure for converting shift position to shift-related quantity (Fig. 11)]
The storage device of the machine
シフトレールの左端から右端までの長さ(左右方向の長さ)は、作業する通路の通路幅に応じて、種々の長さとされる場合がある。この長さが変更された場合、アーム32を目標シフト位置へと左右にシフト移動させるシフトフィードバック制御の制御ゲインを調整する必要がある。しかし、上記の換算角度に変換すれば、左右方向の長さが、どのような長さであっても、左シフト限界位置は換算角度−90[°]、右シフト限界位置は換算角度+90[°]となり、シフトレールの左右方向の長さに応じて制御ゲインを調整する必要がなくなるので便利である。以下、図11に示すシフト位置・換算角度特性に基づいて、シフト位置を変換した換算角度の値を「シフト関連量」と記載する(つまり、シフト関連量=換算角度である)。機台制御装置40は、現在のアーム32(フォーク35)のシフト位置から求めた現在シフト関連量を記憶する。そして機台制御装置40は、ステップS515へと処理を進める。以上に記憶した現在ローテート角度、現在シフト関連量、操作レバーの傾倒方向及び操作量である操作手段操作状態、特殊ボタンのON/OFF状態、は以下の処理にて使用される。
The length from the left end to the right end of the shift rail (length in the left-right direction) may be various lengths depending on the passage width of the passage to be worked. When this length is changed, it is necessary to adjust the control gain of the shift feedback control that shifts the
なお、アーム32のシフト位置については、シフトレール31の左右方向の中心位置から右方向「+」への距離、シフトレール31の左右方向の中心位置から左方向「−」への距離、で表してもよいが、本実施の形態では、シフト位置を、以上に説明したシフト関連量(換算角度)に変換して制御に使用している。
The shift position of the
ステップS515にて機台制御装置40は、図16に示すシフト・ローテート同期基準特性(同期基準特性に相当)と、現在フォーク状態(現在ローテート角度、現在シフト関連量のフォークの状態)と、に基づいて、現在フォーク状態が、シフト・ローテート同期基準特性における禁止領域内(左禁止領域AL内または右禁止領域AR内)に入っているか否かを判定し、現在フォーク状態が禁止領域内に入っている場合(Yes)はステップS530に進み、現在フォーク状態が禁止領域内に入っていない場合(No)はステップS520に進む。ステップS515の処理は、現在フォーク状態が、シフト・ローテート同期基準特性における禁止領域であるか否かを判定する禁止領域内確認ステップに相当している。
In step S515, the machine
なお、機台制御装置40の記憶装置には、図16に示すシフト・ローテート同期基準特性(同期基準特性に相当)が記憶されている。図16に示すシフト・ローテート同期基準特性は、横軸がシフト関連量(換算角度)、縦軸がローテート角度とされている。図16に示すシフト・ローテート同期基準特性において、右ホームポジションHRの座標(換算角度、ローテート角度)は、HR(+90、−90)であり、左ホームポジションHLの座標(換算角度、ローテート角度)は、HL(−90、+90)である。また、中央ホームポジションHCの座標(換算角度、ローテート角度)は、HC(0、0)である。そして図16に示すシフト・ローテート同期基準特性は、HL(−90、+90)、HC(0、0)、HR(+90、−90)を通る直線(同期基準直線S)である。この同期基準直線Sは、左ホームポジションから右ホームポジションへと、右シフト動作(右側へのシフト移動)を行いながら左ローテート動作(左旋回)を行う同期動作、及び、右ホームポジションから左ホームポジションへと、左シフト動作(左側へのシフト移動)を行いながら右ローテート動作(右旋回)を行う同期動作、を示す軌跡である。また、図16に示すシフト・ローテート同期基準特性には、フォーク35がフォークリフトの車体の幅よりも左右に突出するローテート角度及びシフト関連量となる領域が、禁止領域として設定されている。図16に示す例では、禁止領域は、ハッチングにて示した左禁止領域ALと、右禁止領域ARと、を有している。
The shift / rotate synchronization reference characteristic (corresponding to the synchronization reference characteristic) shown in FIG. 16 is stored in the storage device of the machine
ステップS520に進んだ場合、機台制御装置40は、禁止領域内に入っていないことをオペレータに伝えるために、モニタ47に禁止領域内であることの警告をしていた場合は当該表示を中止し、音声出力装置48から禁止領域内であることの警告を出力していた場合は当該出力を中止し、禁止領域内であることの警告を示すランプ49を点灯させていた場合は当該ランプを消灯して、ステップS525に進む。
When the process proceeds to step S520, the machine
ステップS525に進んだ場合、機台制御装置40は、図10に示すSUB100の処理を実行する。以下、まず図10に示すSUB100の処理について説明する。SUB100の処理は、現在フォーク状態が禁止領域内に入っていない場合における許可領域内の処理である。
When the process proceeds to step S525, the machine
●[現在フォーク状態が禁止領域内に入っていない場合の処理(図10:SUB100の処理)]
図10に示すSUB100に進んだ場合、機台制御装置40は、ステップS115へと処理を進める。
● [Processing when the fork state is not currently in the prohibited area (Fig. 10: Processing of SUB100)]
When the process proceeds to SUB100 shown in FIG. 10, the machine
ステップS115にて機台制御装置40は、特殊ボタンがON状態(押されている状態)であるか否かを判定し、ON状態である場合(Yes)はステップS220に進み、ON状態でない場合(No)はステップS120に進む。
In step S115, the machine
ステップS220に進んだ場合、機台制御装置40は、特殊ボタンがON状態とされていることをオペレータに伝えるために、モニタ47に警告表示を行ったり、音声出力装置48から音声で警告したり、警告を示すランプ49を点灯させたりして、ステップS225に進む。
When the process proceeds to step S220, the machine
ステップS225にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS335に進み、前または後ろでない場合(No)はステップS230に進む。
In step S225, the machine
[ローテートのみの実行]
ステップS335に進んだ場合、機台制御装置40は、以下のステップS335、S340にて、シフトフィードバック制御を行わずローテートフィードバック制御(特殊ボタンON時のローテート)のみを実行する。ステップS335にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。例えば、操作レバーの傾倒方向=前、操作角度=θ1の場合、図14に示すように、加算ローテート量=+R1rと求める。なお、前後操作量・加算ローテート量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算ローテート量特性は、横軸が前後の操作量(操作角度)、縦軸が加算ローテート量とされている。なお、前後操作量・加算ローテート量特性は、図14に示す特性に限定されるものではない。そして加算ローテート量を求めた機台制御装置40は、現在ローテート角度に、求めた加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS340に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。
[Run Rotate Only]
When the process proceeds to step S335, the machine
ステップS340にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、処理を終了する。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。
In step S340, the machine
また、ステップS230に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS245に進み、左または右でない場合(No)は、操作レバーが中立位置であるので、処理を終了する。
Further, when the process proceeds to step S230, the machine
[シフトのみの実行]
ステップS245に進んだ場合、機台制御装置40は、以下のステップS245、S265にてシフトフィードバック制御(特殊ボタンON時のシフト)のみを実行する。ステップS245にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、右または左)及び操作量(操作角度)と、図13に示す左右操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。例えば、操作レバーの傾倒方向=右、操作角度=θ3の場合、図13に示すように、加算シフト関連量=+R3sと求める。なお、左右操作量・加算シフト関連量特性は、機台制御装置40の記憶装置に記憶されている。左右操作量・加算シフト関連量特性は、横軸が左右の操作量(操作角度)、縦軸が加算シフト関連量とされている。なお、左右操作量・加算シフト関連量特性は、図13に示す特性に限定されるものではない。そして加算シフト関連量を求めた機台制御装置40は、現在シフト関連量(換算角度)に、求めた加算シフト関連量を加算して目標シフト関連量(目標換算角度)を求め、求めた目標シフト関連量を記憶し、ステップS265に進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。
[Execute shift only]
When the process proceeds to step S245, the machine
ステップS265にて機台制御装置40は、目標シフト関連量(目標換算角度)と、現在シフト関連量(換算角度)と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。
In step S265, the machine
また、ステップS120に進んだ場合、機台制御装置40は、特殊ボタンがOFF状態とされているので、モニタ47における特殊ボタンONの警告表示を中止したり、音声出力装置48における特殊ボタンONの警告出力を中止したり、特殊ボタンのONを示すランプ49を消灯させたりして、ステップS125に進む。
Further, when the process proceeds to step S120, since the special button is turned off in the machine
ステップS125にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS245に進み、左または右でない場合(No)はステップS130に進む。なお、ステップS245に進んだ場合のステップS245、S265の処理については、すでに説明しているので説明を省略する。
In step S125, the machine
ステップS130に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS135に進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。
When the process proceeds to step S130, the machine
[ローテートとシフトの自動同期制御の実行]
ステップS135〜S165の処理は、(操作レバーが操作されて)フォーク35の状態を右ホームポジションにする右ホームポジション指示、あるいはフォーク35の状態を左ホームポジションにする左ホームポジション指示、が入力された場合の処理である。なお、以下では、現在フォーク状態が、図16中において、P1(現在のシフト関連量、現在のローテート角度)=P1(+30、−60)の状態から、操作レバーを「前」に傾倒(操作角度=θ1)させて、左ホームポジション指示をした場合を、具体的な例として説明する。
[Execute automatic synchronization control of rotation and shift]
In the process of steps S135 to S165, a right home position instruction for setting the state of the
ステップS135に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。そして加算ローテート量を求めた機台制御装置40は、現在ローテート角度に、求めた加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS140に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。
When the process proceeds to step S135, the machine
具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「前」、操作量=θ1と、図14の前後操作量・加算ローテート量より、加算ローテート量=+R1r[°]を求める。そして機台制御装置40は、現在ローテート角度+加算ローテート量(+R1r)より、目標ローテート角度を求め、求めた目標ローテート角度を記憶する。これを図16中に示すと、現在の状態であるP1(+30、−60)における現在ローテート角度P1r(=−60)に対して求めた目標ローテート角度であるT1rは、−60+R1rである。ここで仮に+R1r=10[°]とすると、目標ローテート角度であるT1r=−60+10=−50[°]となる。なお、ステップS135は、目標ローテート角度算出ステップに相当している。
Specifically, in the machine
ステップS140にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、ステップS145に進む。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。
In step S140, the
具体的には、機台制御装置40は、目標ローテート角度T1r(=−50[°])と、現在ローテート角度P1r(=−60[°])と、の偏差に基づいて、フィードバック制御量を求め、求めた制御量に基づいて、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動する。また、ステップS140は、ローテートフィードバック制御ステップに相当している。
Specifically, the machine
ステップS145にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図15に示す前後操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。なお、前後操作量・加算シフト関連量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算シフト関連量特性は、横軸が前後の操作量(操作角度)、縦軸が加算シフト関連量とされている。なお、前後操作量・加算シフト関連量特性は、図15に示す特性に限定されるものではない。
In step S145, the machine
具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「前」、操作量=θ1と、図15の前後操作量・加算シフト関連量特性より、加算シフト関連量=−R1s[°]を求める。
Specifically, the machine
加算シフト関連量を求めた機台制御装置40は、現在ローテート角度と、図16に示すシフト・ローテート同期基準特性とに基づいて、現在ローテート角度に対応するシフト関連量(換算角度)である同期シフト関連量を求め、求めた同期シフト関連量に加算シフト関連量を加算して目標シフト関連量(目標換算角度)を求め、求めた目標シフト関連量を記憶し、ステップS150に進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。
The machine
具体的には、機台制御装置40は、図16中の同期基準直線S上において、現在のフォークの状態であるP1(+30、−60)における現在ローテート角度であるP1r(=−60[°])に対応するシフト関連量(換算角度)である同期シフト関連量となるP1s(=+60[°])を求める。そして機台制御装置40は、同期シフト関連量P1s(=+60[°])+加算シフト関連量(=−R1s)より、目標シフト関連量を求め、求めた目標シフト関連量を記憶する。これを図16中に示すと、現在の状態であるP1(+30、−60)に対応する同期シフト関連量P1s(=+60)+加算シフト関連量(=−R1s)=目標シフト関連量である。ここで仮に−R1s=−10[°]とすると、目標シフト関連量であるT1s=+60−10=+50[°]となる。すなわち、ステップS135にて求めた目標ローテート角度T1r(=−50)と、ステップS145にて求めた目標シフト関連量T1s(=+50)で表されるT1(+50、−50)が、現在のフォークの状態のP1(+30、−60)から向かうべき目標状態である。なお、ステップS145は、目標シフト関連量算出ステップに相当している。
Specifically, the machine
ステップS150にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前であるか否かを判定し、前である場合(Yes)はステップS155に進み、前でない場合(No)はステップS160に進む。
In step S150, the machine
ステップS155に進んだ場合、機台制御装置40は、ステップS145にて求めた目標シフト関連量が、現在シフト関連量よりも右(+の側)にあるか否かを判定し、右(+の側)にある場合(Yes)は処理を終了し、右(+の側)でない場合(No)はステップS165に進む。つまり、左ホームポジション指示が入力された際に求めた目標シフト関連量が、現在シフト関連量に対して、フォークを右シフト動作させると判定した場合、シフトフィードバック制御を中止(スキップ)する。
When the process proceeds to step S155, the machine
具体的には、図16中において、オペレータが、操作レバーを傾倒方向=「前」に操作して、現在のフォークの状態であるP1(+30、−60)から左ホームポジション指示をしたにもかかわらず、目標シフト関連量T1s(=+50)が、現在シフト関連量(=+30)よりも右(+の側)にある場合、フォークは右シフト動作することになる(ただし、しばらく右シフト動作した後、目標シフト関連量が、現在シフト関連量よりも左(−の側)になり、左シフト動作になる)。オペレータは、「左」ホームポジションへと向かう指示をしたにもかかわらず、アーム(フォーク)が「右」へのシフト動作を開始すると、誤操作をしたと勘違いして、逆に操作(この場合、操作レバーを「後ろ」に傾倒)してしまう可能性があるので、あまり好ましくない。そこで、左ホームポジション指示をした場合、目標シフト関連量が、現在シフト関連量よりも右(+の側)にある場合は、シフトフィードバック制御を行わず、ローテートフィードバック制御のみを行う。ステップS155も同様の考えであり、ステップS155では、右ホームポジション指示をした場合、目標シフト関連量が、現在シフト関連量よりも左(−の側)にある場合は、シフトフィードバック制御を行わず、ローテートフィードバック制御のみを行う。なお、図16中において、現在のフォークの状態がP1(+30、−60)から左ホームポジション指示をした場合、ステップS150、S155、S160によって、P1(+30、−60)から、実線にて示す軌跡Ktにて、シフト及びローテートの同期動作を行いながら左ホームポジションへと向かう。なお、ステップS150、S155、S160を省略して、ステップS145の後、ステップS165を実行するようにしてもよいが、その場合は、図16中に示す軌跡Keに沿って動作する。 Specifically, in FIG. 16, the operator operates the operating lever in the tilting direction = "forward" to instruct the left home position from P1 (+30, -60), which is the current state of the fork. Regardless, if the target shift-related amount T1s (= +50) is to the right (+ side) of the current shift-related amount (= +30), the fork will shift to the right (however, shift to the right for a while). After that, the target shift-related amount becomes left (-side) from the current shift-related amount, and the left shift operation is performed). When the operator starts the shift operation to the "right" even though the operator has instructed to move to the "left" home position, he misunderstands that he has made an erroneous operation and operates in reverse (in this case, in this case). It is not very preferable because it may tilt the operating lever "backward"). Therefore, when the left home position is instructed and the target shift-related amount is to the right (+ side) of the current shift-related amount, the shift feedback control is not performed and only the rotate feedback control is performed. The same idea applies to step S155. In step S155, when the right home position is instructed and the target shift-related amount is to the left (-side) of the current shift-related amount, shift feedback control is not performed. , Performs only rotate feedback control. In FIG. 16, when the current fork state indicates the left home position from P1 (+30, -60), it is shown by a solid line from P1 (+30, -60) in steps S150, S155, and S160. At the locus Kt, the player heads to the left home position while performing synchronous shift and rotate operations. Although steps S150, S155, and S160 may be omitted and step S165 may be executed after step S145, in that case, the operation is performed along the locus Ke shown in FIG.
ステップS160に進んだ場合、機台制御装置40は、ステップS145にて求めた目標シフト関連量が、現在シフト関連量よりも左(−の側)にあるか否かを判定し、左(−の側)にある場合(Yes)は処理を終了し、左(−の側)でない場合(No)はステップS165に進む。つまり、右ホームポジション指示が入力された際に求めた目標シフト関連量が、現在シフト関連量に対して、フォークを左シフト動作させると判定した場合、シフトフィードバック制御を中止(スキップ)する。
When the process proceeds to step S160, the machine
ステップS165に進んだ場合、機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在ローテート角度に対応するシフト関連量である同期シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。また、同期基準直線Sから離れているほど偏差が大きくなってシフト動作の速度が大きくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、右ホームポジションや左ホームポジションでなくても、上記のとおり、現在のフォークのシフト位置やローテート角度にかかわらず、右ホームポジションや左ホームポジションへの移動を実行することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。なお、ステップS165は、シフトフィードバック制御ステップに相当している。
When the process proceeds to step S165, the machine
なお、図16における現在のフォークがP1(+30、−60)の状態のとき、オペレータが右ホームポジション指示を入力した場合、フォークは二点鎖線にて示す軌跡Ksに沿って右ホームポジションへと移動する。 When the current fork in FIG. 16 is in the state of P1 (+30, -60) and the operator inputs the right home position instruction, the fork moves to the right home position along the trajectory Ks indicated by the alternate long and short dash line. Moving.
●[現在フォーク状態が禁止領域内に入っている場合の処理(図9:ステップS530以降の処理)]
次に、図9のステップS530の説明に戻り、図9におけるステップS530以降の処理について説明する。なお、図17は、図16中の同期基準直線S、左禁止領域AL、右禁止領域ARと同一の同期基準直線S、左禁止領域AL、右禁止領域ARを有する、シフト・ローテート同期基準特性を示している。当該図17を用いて、図9に示すフローチャートの処理の具体的な例を説明する。
● [Processing when the fork state is currently in the prohibited area (Fig. 9: Processing after step S530)]
Next, returning to the description of step S530 of FIG. 9, the processing after step S530 in FIG. 9 will be described. Note that FIG. 17 has a shift-rotate synchronization reference characteristic having the same synchronization reference line S, left prohibition region AL, and right prohibition region AR as the synchronization reference straight line S, left prohibition region AL, and right prohibition region AR in FIG. Is shown. A specific example of the processing of the flowchart shown in FIG. 9 will be described with reference to FIG.
ステップS530にて機台制御装置40は、現在ローテート角度が+90[°]または−90[°]であるか否かを判定し、現在ローテート角度が+90[°]または−90[°]である場合(Yes)はステップS535Aに進み、現在ローテート角度が+90[°]または−90[°]でない場合(No)はステップS535Bに進む。
In step S530, the machine
ステップS535Aに進んだ場合、機台制御装置40は、現在フォーク状態が禁止領域内に入っているが、右ホームポジションからの左右のシフト動作中、または左ホームポジションからの左右のシフト動作中であって、通常の荷役作業中である、と判定して禁止領域内であることの警告を解除する。例えば、機台制御装置40は、モニタ47に禁止領域内であることの警告をしていた場合は当該表示を中止し、音声出力装置48から禁止領域内であることの警告を出力していた場合は当該出力を中止し、禁止領域内であることの警告を示すランプ49を点灯させていた場合は当該ランプを消灯して、ステップS540に進む。
When the process proceeds to step S535A, the
ステップS535Bに進んだ場合、機台制御装置40は、荷役作業中でない状態で、現在フォーク状態が禁止領域内に入っていると判定し、禁止領域内であることの警告を発する。例えば、機台制御装置40は、モニタ47に禁止領域内であることの警告表示し、音声出力装置48から禁止領域内であることの警告を出力し、禁止領域内であることの警告を示すランプ49を点灯させ、ステップS540に進む。
When the process proceeds to step S535B, the machine
ステップS540にて機台制御装置40は、特殊ボタンがON状態(押されている状態)であるか否かを判定し、ON状態である場合(Yes)はステップS645に進み、ON状態でない場合(No)はステップS545に進む。
In step S540, the machine
ステップS645に進んだ場合、機台制御装置40は、特殊ボタンがON状態とされていることをオペレータに伝えるために、特殊ボタンがONであることを、モニタ47に表示したり、音声出力装置48から音声を出力したり、警告を示すランプ49を点灯させたりして、ステップS650に進む。
When the process proceeds to step S645, the machine
ステップS650にて機台制御装置40は、操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS765に進み、前または後ろでない場合(No)はステップS655に進む。
In step S650, the machine
ステップS765に進んだ場合、機台制御装置40は、以下のステップS765、S780にて、シフトフィードバック制御を行わずローテートフィードバック制御(特殊ボタンON時のローテート)のみを実行する。ステップS765にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。例えば、操作レバーの傾倒方向=前、操作角度=θ1の場合、図14に示すように、加算ローテート量=+R1rと求める。なお、前後操作量・加算ローテート量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算ローテート量特性は、横軸が前後の操作量(操作角度)、縦軸が加算ローテート量とされている。なお、前後操作量・加算ローテート量特性は、図14に示す特性に限定されるものではない。そして加算ローテート量を求めた機台制御装置40は、現在ローテート角度に、求めた加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS780に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。
When the process proceeds to step S765, the machine
ステップS780にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、処理を終了する。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。
In step S780, the machine
例えば、図17中において、現在フォーク状態がQ2(−30、−90)の場合(禁止領域内に入っている場合)に、オペレータが特殊ボタンをON、かつ操作レバーを「前」に傾倒させた場合、機台制御装置40は、ステップS765、S780の処理にて、フォークを右に旋回させる。そして、図17中において、現在フォーク状態がQ3(−30、−60)となった時点で、オペレータが、特殊ボタンをOFF、かつ操作レバーを「中立」とした場合、フォーク状態はQ3(−30、−60)の状態で維持される。
For example, in FIG. 17, when the fork state is currently Q2 (-30, -90) (when it is in the prohibited area), the operator turns on the special button and tilts the operation lever "forward". In this case, the machine
また、ステップS655に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS665に進み、左または右でない場合(No)は、操作レバーが中立位置であるので、処理を終了する。
Further, when the process proceeds to step S655, the machine
ステップS665に進んだ場合、機台制御装置40は、以下のステップS665、S680にてシフトフィードバック制御(特殊ボタンON時のシフト)のみを実行する。ステップS665にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、右または左)及び操作量(操作角度)と、図13に示す左右操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。例えば、操作レバーの傾倒方向=右、操作角度=θ3の場合、図13に示すように、加算シフト関連量=+R3sと求める。なお、左右操作量・加算シフト関連量特性は、機台制御装置40の記憶装置に記憶されている。左右操作量・加算シフト関連量特性は、横軸が左右の操作量(操作角度)、縦軸が加算シフト関連量とされている。なお、左右操作量・加算シフト関連量特性は、図13に示す特性に限定されるものではない。そして加算シフト関連量を求めた機台制御装置40は、現在シフト関連量(換算角度)に、求めた加算シフト関連量を加算して目標シフト関連量(目標換算角度)を求め、求めた目標シフト関連量を記憶し、ステップS680に進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。
When the process proceeds to step S665, the machine
ステップS680にて機台制御装置40は、目標シフト関連量(目標換算角度)と、現在シフト関連量(換算角度)と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。
In step S680, the machine
例えば、図17中において、現在フォーク状態がQ3(−30、−60)の場合(禁止領域内に入っている場合)に、オペレータが特殊ボタンをON、かつ操作レバーを「右」に傾倒させた場合、機台制御装置40は、ステップS665、S680の処理にて、フォークを右に移動させる。そして、図17中において、現在フォーク状態がQ4(+10、−60)となった時点で、オペレータが、特殊ボタンをOFF、かつ操作レバーを「中立」とした場合、フォーク状態はQ4(+10、−60)の状態で維持される。
For example, in FIG. 17, when the fork state is currently Q3 (-30, -60) (when it is in the prohibited area), the operator turns on the special button and tilts the operation lever to the "right". If so, the machine
また、ステップS545に進んだ場合、機台制御装置40は、特殊ボタンがOFF状態とされているので、モニタ47における特殊ボタンONの警告表示を中止したり、音声出力装置48における特殊ボタンONの警告出力を中止したり、特殊ボタンのONを示すランプ49を消灯させたりして、ステップS550に進む。
Further, when the process proceeds to step S545, since the special button is turned off in the machine
ステップS550にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS560に進み、左または右でない場合(No)はステップS555に進む。
In step S550, the machine
ステップS560に進んだ場合、機台制御装置40は、現在ローテート角度が+90[°]または−90[°]であるか否かを判定し、現在ローテート角度が+90[°]または−90[°]である場合(Yes)はステップS665に進み、現在ローテート角度が+90[°]または−90[°]でない場合(No)はステップS565に進む。
If the process proceeds to step S560, the
ステップS560にて(Yes)と判定されて、ステップS665に進んだ場合のステップS665、S680の処理については、すでに説明しているので説明を省略する。また、ステップS560にて(Yes)と判定された後のステップS665、S680の処理は、禁止領域内において左ホームポジションのフォークを左右にシフト動作させる処理、または、禁止領域内において右ホームポジションのフォークを左右にシフト動作させる処理である。 The processing of steps S665 and S680 when (Yes) is determined in step S560 and the process proceeds to step S665 has already been described, and thus the description thereof will be omitted. Further, the processing of steps S665 and S680 after the determination of (Yes) in step S560 is the processing of shifting the fork of the left home position to the left or right in the prohibited area, or the processing of the right home position in the prohibited area. This is a process that shifts the fork left and right.
例えば、図17中において、現在フォーク状態がQ1(−90、−90)の場合(禁止領域内に入っている場合)に、オペレータが特殊ボタンをOFF、かつ操作レバーを「右」に傾倒させた場合、機台制御装置40は、ステップS560を経由してステップS665、S680の処理にて、フォークを右に移動させる。そして、図17中において、現在フォーク状態がQ2(−30、−90)となった時点で、オペレータが、操作レバーを「中立」とした場合、フォーク状態はQ2(−30、−90)の状態で維持される。また、このとき、ローテート角度は−90[°]であり、通常の荷役作業であるので、ステップS535Aにて、禁止領域の警告は解除されている。
For example, in FIG. 17, when the fork state is currently Q1 (-90, -90) (when it is in the prohibited area), the operator turns off the special button and tilts the operation lever to the "right". In this case, the machine
ステップS555に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS565に進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。
When the process proceeds to step S555, the machine
ステップS565〜S580の処理は、現在フォーク状態が禁止領域内に入っている場合において、オペレータから、フォークの状態を右ホームポジションにする右ホームポジション指示、あるいはフォークの状態を左ホームポジションにする左ホームポジション指示、が入力された場合の処理である。なお、このステップS565〜S580の処理は、現在フォーク状態が禁止領域内であると判定した場合に、ローテート駆動装置の制御を禁止するローテート動作禁止ステップに相当している。 In steps S565 to S580, when the fork state is currently in the prohibited area, the operator instructs the right home position to set the fork state to the right home position, or the left to set the fork state to the left home position. This is the process when the home position instruction is input. The process of steps S565 to S580 corresponds to the rotate operation prohibition step for prohibiting the control of the rotate drive device when it is determined that the fork state is currently in the prohibited area.
ステップS565に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図15に示す前後操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。そして加算シフト関連量を求めた機台制御装置40は、現在シフト関連量に、求めた加算シフト関連量を加算して目標シフト関連量を求め、求めた目標シフト関連量を記憶し、ステップS570に進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。
When the process proceeds to step S565, the machine
具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「後ろ」、操作量=θ2の場合、図15の前後操作量・加算シフト関連量より、加算シフト関連量=+R2s[°]を求める。そして機台制御装置40は、現在シフト関連量+加算シフト関連量(+R2s)より、目標シフト関連量を求め、求めた目標シフト関連量を記憶する。これを図17中に示すと、例えば、現在の状態がQ1(−90、−90)、加算シフト関連量=+R2s=+10[°]の場合、Q1(−90、−90)の現在シフト関連量(−90)に対する目標シフト関連量は−90+10=−80[°]となる。
Specifically, when the tilting direction of the operating lever based on the operating state of the operating means = "rear" and the operating amount = θ2, the machine
ステップS570にて機台制御装置40は、現在フォーク状態が図17中における左禁止領域内に入っており、かつ、現在シフト関連量に対して目標シフト関連量が右側(+側)、であるか否かを判定し、満足している場合(Yes)はステップS580に進み、満足していない場合(No)はステップS575に進む。
In step S570, the
ステップS575に進んだ場合、機台制御装置40は、現在フォーク状態が図17中における右禁止領域内に入っており、かつ、現在シフト関連量に対して目標シフト関連量が左側(−側)、であるか否かを判定し、満足している場合(Yes)はステップS580に進み、満足していない場合(No)は処理を終了する。
When the process proceeds to step S575, the
ステップS580に進んだ場合、機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。
When the process proceeds to step S580, the machine
上記のステップS570〜S580の処理は、現在フォーク状態が禁止領域内に入っていると判定した場合に、目標シフト関連量に向かうシフト動作の方向が、禁止領域から脱出する方向であると判定した場合に、シフトフィードバック制御する、禁止領域脱出シフト制御ステップに相当している。なお、目標シフト関連量に向かうシフト動作の方向が、禁止領域から脱出する方向とは逆方向の場合、シフトフィードバック制御を禁止する。 In the process of steps S570 to S580 described above, when it is determined that the fork state is currently in the prohibited area, it is determined that the direction of the shift operation toward the target shift-related amount is the direction of escaping from the prohibited area. In this case, it corresponds to the prohibited area escape shift control step of controlling the shift feedback. When the direction of the shift operation toward the target shift-related amount is opposite to the direction of exiting the prohibited area, the shift feedback control is prohibited.
具体的には、例えば図17において、現在フォーク状態が、左禁止領域内のQ4(+10、−60)である場合、オペレータから、特殊ボタン=OFF、操作レバー=「後ろ」に傾倒(右ホームポジション指示)、が入力された場合、機台制御装置40は、ステップS565〜S580の処理にて、フォークを右シフト動作させる。なお、当該右シフト動作にて、左禁止領域内に入っていたフォークが、図17中のP1(+30、−60)に到達して左禁止領域内から脱出した場合、ステップS515、S520、S525の経路にて図10に示すSUB100へと処理が移行する。そして図10のSUB100におけるステップS130〜S165にて上述したとおり、シフト動作とローテート動作の同期動作へと自動的に移行する。つまり、例えば、現在フォーク状態が、左禁止領域内のQ4(+10、−60)である場合、オペレータは、特殊ボタン=OFF、操作レバー=「後ろ」に傾倒(右ホームポジション指示)の入力を継続しているだけでよい。機台制御装置40は、禁止領域を脱出するまでは、図17中のQ4(+10、−60)からP1(+30、−60)に向かうように、右シフト動作のみを自動的に行う。そして禁止領域を脱出した後、機台制御装置40は、P1(+30、−60)から右ホームポジションへと向かう同期制御へと制御を自動的に移行させる。
Specifically, for example, in FIG. 17, when the current fork state is Q4 (+10, -60) in the left prohibited area, the operator tilts the special button = OFF and the operation lever = "back" (right home). When the position instruction) is input, the machine
●[現在フォーク状態が禁止領域内に入っていない場合の処理における第2の実施の形態(図18:SUB100の処理)]
以上に説明した第1の実施の形態の図10のSUB100(許可領域内処理)では、同期動作時におけるシフト動作について、現在ローテート角度を基準として、現在ローテート角度に対応する同期シフト関連量から目標シフト関連量を求めることで、同期基準直線Sに近づけた。第2の実施の形態では、同期動作時におけるローテート動作について、現在シフト関連量を基準として、現在シフト関連量に対応する同期ローテート角度から目標ローテート角度を求めることで、同期基準直線Sに近づける。
● [Second embodiment in processing when the fork state is not currently in the prohibited area (FIG. 18: processing of SUB100)]
In the SUB 100 (processing in the permitted area) of FIG. 10 of the first embodiment described above, the shift operation during the synchronous operation is targeted from the synchronous shift-related amount corresponding to the current rotate angle with the current rotate angle as a reference. By obtaining the shift-related quantity, the synchronization reference straight line S was approached. In the second embodiment, the rotation operation during the synchronous operation is brought closer to the synchronization reference straight line S by obtaining the target rotation angle from the synchronous rotation angle corresponding to the current shift-related amount with the current shift-related amount as a reference.
次に図18に示すフローチャートを用いて、機台制御装置40によるシフトモータ31Mとローテートモータ33Mの制御の処理手順について説明する。図18に示すフローチャートは、第1の実施の形態のフローチャートにおける図10の置き換えとなるフローチャートを示している。そして図18に示す第2の実施の形態のフローチャートは、第1の実施の形態の図10のフローチャートに対して、ステップS135A、S140A、S145A、S155A、S160A、S165Aの処理が異なり、他の処理は同じである。以下、フローチャートの相違点について主に説明する。
Next, the processing procedure for controlling the
ステップS130に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS135Aに進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。
When the process proceeds to step S130, the machine
[ローテートとシフトの自動同期制御の実行]
ステップS135A〜S165Aの処理は、(操作レバーが操作されて)フォーク35の状態を右ホームポジションにする右ホームポジション指示、あるいはフォーク35の状態を左ホームポジションにする左ホームポジション指示、が入力された場合の処理である。
[Execute automatic synchronization control of rotation and shift]
In the processing of steps S135A to S165A, a right home position instruction for setting the state of the
なお、機台制御装置40の記憶装置には、図19に示すシフト・ローテート同期基準特性(同期基準特性に相当)が記憶されている。なお、図19に示す同期基準直線S、左禁止領域AL及び右禁止領域ARは、図16に示す同期基準直線S、左禁止領域AL及び右禁止領域ARと同じである。以下では、図19中において、左右方向の位置、及びローテート角度が、P2(現在のシフト関連量、現在のローテート角度)=P2(+30、−60)の状態から、操作レバーを「後ろ」に傾倒(操作角度=θ2)させて、右ホームポジション指示をした場合を、具体的な例として説明する。
The shift / rotate synchronization reference characteristic (corresponding to the synchronization reference characteristic) shown in FIG. 19 is stored in the storage device of the machine
ステップS135Aに進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図15に示す前後操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。そして加算シフト関連量を求めた機台制御装置40は、現在シフト関連量に、求めた加算シフト関連量を加算して目標シフト関連量を求め、求めた目標シフト関連量を記憶し、ステップS140Aに進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。
When the process proceeds to step S135A, the machine
具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「後ろ」、操作量=θ2と、図15の前後操作量・加算シフト関連量より、加算シフト関連量=+R2s[°]を求める。そして機台制御装置40は、現在シフト関連量+加算シフト関連量(+R2s)より、目標シフト関連量を求め、求めた目標シフト関連量を記憶する。これを図19中に示すと、現在の状態であるP2(+30、−60)における現在シフト関連量P2s(=+30)に対して求めた目標シフト関連量であるT2sは、+30+R2sである。ここで仮に+R2s=10[°]とすると、目標シフト関連量であるT2s=+30+10=+40[°]となる。なお、ステップS135Aは、目標シフト関連量算出ステップに相当している。
Specifically, in the machine
ステップS140Aにて機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、ステップS145Aに進む。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。
In step S140A, the machine
具体的には、機台制御装置40は、目標シフト関連量T2s(=+40[°])と、現在シフト関連量P2s(=+30[°])と、の偏差に基づいて、フィードバック制御量を求め、求めた制御量に基づいて、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動する。また、ステップS140Aは、シフトフィードバック制御ステップに相当している。
Specifically, the machine
ステップS145Aにて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。なお、前後操作量・加算ローテート量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算ローテート量特性は、横軸が前後の操作量(操作角度)、縦軸が加算ローテート量とされている。なお、前後操作量・加算ローテート量特性は、図14に示す特性に限定されるものではない。
In step S145A, the machine
具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「後ろ」、操作量=θ2と、図14の前後操作量・加算ローテート量特性より、加算ローテート量=−R2r[°]を求める。
Specifically, the machine
加算ローテート量を求めた機台制御装置40は、現在シフト関連量と、図19に示すシフト・ローテート同期基準特性とに基づいて、現在シフト関連量に対応するローテート角度である同期ローテート角度を求め、求めた同期ローテート角度に加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS150に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。
The machine
具体的には、機台制御装置40は、図19中の同期基準直線S上において、現在のフォークの状態であるP2(+30、−60)における現在シフト関連量であるP2s(=+30[°])に対応するローテート角度である同期ローテート角度となるP2r(=−30[°])を求める。そして機台制御装置40は、同期ローテート角度P2r(=−30[°])+加算ローテート角度(=−R2r)より、目標ローテート角度を求め、求めた目標ローテート角度を記憶する。これを図19中に示すと、現在の状態であるP2(+30、−60)に対応する同期ローテート角度P2r(=−30)+加算ローテート量(=−R2r)=目標ローテート角度である。ここで仮に−R2r=−10[°]とすると、目標ローテート角度であるT2r=−30−10=−40[°]となる。すなわち、ステップS135Aにて求めた目標シフト関連量T2s(=+40)と、ステップS145Aにて求めた目標ローテート角度T2r(=−40)で表されるT2(+40、−40)が、現在のフォークの状態のP2(+30、−60)から向かうべき目標状態である。なお、ステップS145Aは、目標ローテート角度算出ステップに相当している。
Specifically, the machine
ステップS150にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前であるか否かを判定し、前である場合(Yes)はステップS155Aに進み、前でない場合(No)はステップS160Aに進む。
In step S150, the machine
ステップS155Aに進んだ場合、機台制御装置40は、ステップS145Aにて求めた目標ローテート角度が、現在ローテート角度よりも左旋回側(−の側)にあるか否かを判定し、左旋回側(−の側)にある場合(Yes)は処理を終了し、左旋回側(−の側)でない場合(No)はステップS165Aに進む。つまり、左ホームポジション指示が入力された際に求めた目標ローテート角度が、現在ローテート角度に対して、フォークを左ローテート動作させると判定した場合、ローテートフィードバック制御を中止(スキップ)する。
When the process proceeds to step S155A, the machine
ステップS160Aに進んだ場合、機台制御装置40は、ステップS145Aにて求めた目標ローテート角度が、現在ローテート角度よりも右旋回側(+の側)にあるか否かを判定し、右旋回側(+の側)にある場合(Yes)は処理を終了し、右旋回側(+の側)でない場合(No)はステップS165Aに進む。つまり、右ホームポジション指示が入力された際に求めた目標ローテート角度が、現在ローテート角度に対して、フォークを右ローテート動作させると判定した場合、ローテートフィードバック制御を中止(スキップ)する。
When proceeding to step S160A, the machine
具体的には、図19中において、オペレータが、操作レバーを傾倒方向=「後ろ」に操作して、現在のフォークの状態であるP2(+30、−60)から右ホームポジション指示をしたにもかかわらず、目標ローテート角度T2r(=−40)が、現在ローテート角度(=−60)よりも右旋回側(+の側)にある場合、フォークは右ローテート動作することになる(ただし、しばらく右ローテート動作した後、目標ローテート角度が、現在ローテート角度よりも左旋回側(−の側)になり、左ローテート動作になる)。オペレータは、「右」ホームポジションへと向かう指示をしたにもかかわらず、フォークが「右」ローテート動作を開始すると、誤操作をしたと勘違いして、逆に操作(この場合、操作レバーを「前」に傾倒)してしまう可能性があるので、あまり好ましくない。そこで、右ホームポジション指示をした場合、目標ローテート角度が、現在ローテート角度よりも右旋回側(+の側)にある場合は、ローテートフィードバック制御を行わず、シフトフィードバック制御のみを行う。ステップS155Aも同様の考えであり、ステップS155Aでは、左ホームポジション指示をした場合、目標ローテート角度が、現在ローテート角度よりも左旋回側(−の側)にある場合は、ローテートフィードバック制御を行わず、シフトフィードバック制御のみを行う。なお、図19中において、現在のフォークの状態がP2(+30、−60)から右ホームポジション指示をした場合、ステップS150、S155A、S160Aによって、P2(+30、−60)から、実線にて示す軌跡Ktにて、シフト及びローテートの同期動作を行いながら右ホームポジションへと向かう。なお、ステップS150、S155A、S160Aを省略して、ステップS145Aの後、ステップS165Aを実行するようにしてもよいが、その場合は、図19中に示す軌跡Keに沿って動作する。 Specifically, in FIG. 19, the operator operates the operating lever in the tilting direction = "backward" to instruct the right home position from P2 (+30, -60), which is the current state of the fork. Regardless, if the target rotation angle T2r (= -40) is currently on the right turn side (+ side) of the rotation angle (= -60), the fork will rotate to the right (however, for a while). After the right rotation operation, the target rotation angle becomes the left turning side (-side) from the current rotation angle, and the left rotation operation occurs). When the operator starts the "right" rotation operation even though the operator has instructed to move to the "right" home position, he misunderstands that he has made an erroneous operation and operates in reverse (in this case, the operation lever is "forward". It is not very preferable because it may cause you to lean toward. Therefore, when the right home position is instructed and the target rotation angle is on the right turning side (+ side) of the current rotation angle, the rotation feedback control is not performed and only the shift feedback control is performed. Step S155A has the same idea. In step S155A, when the left home position is instructed and the target rotation angle is on the left turning side (-side) of the current rotation angle, the rotation feedback control is not performed. , Only shift feedback control is performed. In FIG. 19, when the current fork state indicates the right home position from P2 (+30, -60), it is shown by a solid line from P2 (+30, -60) in steps S150, S155A, and S160A. At the locus Kt, the player heads to the right home position while performing synchronous shift and rotate operations. Although steps S150, S155A, and S160A may be omitted and step S165A may be executed after step S145A, in that case, the operation is performed along the locus Ke shown in FIG.
ステップS165Aに進んだ場合、機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、処理を終了する。現在シフト関連量に対応するローテート角度である同期ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。また、同期基準直線Sから離れているほど偏差が大きくなってローテート動作の速度が大きくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、右ホームポジションや左ホームポジションでなくても、上記のとおり、現在のフォークのシフト位置やローテート角度にかかわらず、右ホームポジションや左ホームポジションへの移動を実行することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。なお、ステップS165Aは、ローテートフィードバック制御ステップに相当している。
When the process proceeds to step S165A, the machine
なお、図19における現在のフォークがP2(+30、−60)の状態のとき、オペレータが左ホームポジション指示を入力した場合、フォークは二点鎖線にて示す軌跡Ksに沿って左ホームポジションへと移動する。 When the current fork in FIG. 19 is in the state of P2 (+30, -60) and the operator inputs the left home position instruction, the fork moves to the left home position along the trajectory Ks indicated by the alternate long and short dash line. Moving.
本発明のフォークリフトの荷役制御方法、及びフォークリフトの荷役制御装置は、本実施の形態で説明した構成、構造、外観、形状、処理手順等に限定されず、本発明の要旨を変更しない範囲で種々の変更、追加、削除が可能である。 The forklift cargo handling control method of the present invention and the forklift cargo handling control device are not limited to the configuration, structure, appearance, shape, processing procedure, etc. described in the present embodiment, and are various as long as the gist of the present invention is not changed. Can be changed, added, and deleted.
本実施の形態の説明では、ローテート駆動装置及びシフト駆動装置として、電動式のローテートモータ及びシフトモータを用いた例を説明したが、油圧式のローテートモータ及びシフトモータ(シフトシリンダ)を用いてもよい。つまり、種々のローテート駆動装置及びシフト駆動装置に適用することができる。 In the description of the present embodiment, an example in which an electric rotation motor and a shift motor are used as the rotation drive device and the shift drive device has been described, but a hydraulic rotation motor and a shift motor (shift cylinder) may also be used. good. That is, it can be applied to various rotate drive devices and shift drive devices.
本実施の形態の説明では、前後・左右に傾倒可能な操作レバーで操作手段を構成した例を示したが、操作手段はオペレータが操作方向と操作量を操作できるものであればよく、レバータイプとシーソータイプのスイッチの組み合わせや、十字式のシーソータイプのスイッチであってもよい。なお、シーソータイプは、傾け量によって操作量を変更できるものである。 In the description of the present embodiment, an example in which the operating means is configured by an operating lever that can be tilted back and forth and left and right is shown, but the operating means may be a lever type as long as the operator can operate the operating direction and the operating amount. It may be a combination of a seesaw type switch and a cross type seesaw type switch. The seesaw type allows the operation amount to be changed depending on the tilt amount.
本実施の形態の説明では、機台制御装置40が「制御装置」である例を説明したが、2台以上の複数の制御装置で「制御装置」を構成してもよい。本実施の形態の説明では、特殊ボタン44が、ボタン形状の例を示したが、特殊ボタン44は、ボタン形状に限定されず、種々の形状のスイッチであってもよい。
In the description of the present embodiment, the example in which the machine
また、本実施の形態の説明に用いた数値は一例であり、この数値に限定されるものではない。 Further, the numerical values used in the description of the present embodiment are examples, and are not limited to these numerical values.
1 フォークリフト
10 車体
11 ボディ
12 リーチレグ
13 ヘッドガード
14 後方ローラ
15 前方ローラ
16A 駆動操舵輪
16B キャスタ輪
16C 従動輪
16M 走行モータ
17 クロスプレート
20 マスト
21 アウタマスト
22 インナマスト
30 昇降ユニット
30M 昇降モータ
31 シフトレール
31M シフトモータ(シフト駆動装置)
31S シフト位置検出手段
32 アーム
33 ローテートシャフト
33M ローテートモータ(ローテート駆動装置)
33S ローテート角度検出手段
34 フィンガーバ
35 フォーク
36 支持部
40 機台制御装置(制御装置)
41 操作レバー
41S 操作状態検出手段
42S 昇降操作状態検出手段
43S アクセル操作状態検出手段
42 昇降レバー
43 アクセルレバー
44 特殊ボタン
47 モニタ(表示装置)
48 音声出力装置
49 ランプ
50 バッテリ
1
31S Shift position detecting means 32
33S Rotate angle detection means 34
41
48
Claims (4)
車体に対して前記フォークを右回りに旋回させる右ローテート動作、及び車体に対して前記フォークを左回りに旋回させる左ローテート動作、を行うローテート駆動装置と、
操作手段と、
前記操作手段の操作状態に応じて、前記シフト駆動装置と前記ローテート駆動装置を制御する制御装置と、
記憶装置と、
を用いた、フォークリフトの荷役制御方法であって、
車体に対する前記フォークの旋回角度をローテート角度、
車体の左右方向における前記フォークの位置をシフト位置、
前記フォークを右移動させた際のシフト位置の限界である右シフト限界位置、かつ前記フォークを左旋回させた際に前記フォークが車体の前進方向に対して直交する左方向を向いたローテート角度である左向き角度、となるシフト位置及びローテート角度の前記フォークの状態を右ホームポジション、
前記フォークを左移動させた際のシフト位置の限界である左シフト限界位置、かつ前記フォークを右旋回させた際に前記フォークが車体の前進方向に対して直交する右方向を向いたローテート角度である右向き角度、となるシフト位置及びローテート角度の前記フォークの状態を左ホームポジション、
とした場合、
前記右ホームポジションから前記左ホームポジションへと前記左シフト動作を行いながら前記右ローテート動作を同期させた際、あるいは、前記左ホームポジションから前記右ホームポジションへと前記右シフト動作を行いながら前記左ローテート動作を同期させた際、におけるローテート角度に対応させて、シフト位置に関連するシフト関連量が設定されているとともに、前記フォークが車体の幅よりも左右に突出するローテート角度及びシフト関連量となる領域が禁止領域として設定された、同期基準特性を予め前記記憶装置に記憶しておき、
前記操作手段が操作されて、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、が入力された場合に、前記制御装置にて、
現在の前記フォークのローテート角度である現在ローテート角度と、現在の前記フォークのシフト位置に対応するシフト関連量である現在シフト関連量と、に基づいた現在のフォークの状態である現在フォーク状態が、前記同期基準特性における前記禁止領域内であるか否かを判定する、禁止領域内確認ステップと、
前記現在フォーク状態が前記禁止領域内であると判定した場合、前記ローテート駆動装置の制御を禁止する、ローテート動作禁止ステップと、
を有し、
前記制御装置にて、
前記禁止領域内確認ステップにて前記現在フォーク状態が前記禁止領域内であると判定した場合、前記操作手段の操作状態に基づいて求めた目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向であると判定した場合は、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御し、前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向でないと判定した場合は、前記シフト駆動装置のフィードバック制御を中止する、禁止領域脱出シフト制御ステップを有し、
前記制御装置にて、
前記禁止領域脱出シフト制御ステップを実行した後、前記禁止領域内確認ステップにて前記現在フォーク状態が、前記禁止領域内でないと判定した場合に、
前記現在ローテート角度、あるいは前記同期基準特性と前記現在シフト関連量に基づいて求めたローテート角度である同期ローテート角度に、前記操作手段の操作状態に基づいて求めた加算ローテート角度を加算した目標ローテート角度を求める、目標ローテート角度算出ステップと、
前記現在ローテート角度が前記目標ローテート角度に近づくように前記ローテート駆動装置をフィードバック制御する、ローテートフィードバック制御ステップと、
前記同期基準特性と前記現在ローテート角度に基づいて求めたシフト関連量である同期シフト関連量、あるいは前記現在シフト関連量に、前記操作手段の操作状態に基づいて求めた加算シフト関連量を加算した目標シフト関連量を求める、目標シフト関連量算出ステップと、
前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御する、シフトフィードバック制御ステップと、
を有する、
フォークリフトの荷役制御方法。 A shift drive device that performs a right shift operation for moving the fork to the right with respect to the vehicle body and a left shift operation for moving the fork to the left with respect to the vehicle body.
A rotation drive device that performs a right-rotate operation of turning the fork clockwise with respect to the vehicle body and a left-rotate operation of turning the fork counterclockwise with respect to the vehicle body.
Operation means and
A control device that controls the shift drive device and the rotate drive device according to the operation state of the operation means, and
Storage device and
This is a forklift cargo handling control method using
Rotate angle, the turning angle of the fork with respect to the vehicle body
The position of the fork in the left-right direction of the vehicle body is shifted to the shift position.
At the right shift limit position, which is the limit of the shift position when the fork is moved to the right, and at the rotation angle when the fork is oriented to the left orthogonal to the forward direction of the vehicle body when the fork is turned to the left. The state of the fork at a certain leftward angle, a shift position and a rotate angle, is a right home position.
The left shift limit position, which is the limit of the shift position when the fork is moved to the left, and the rotation angle when the fork is oriented to the right orthogonal to the forward direction of the vehicle body when the fork is turned to the right. The state of the fork at the shift position and the rotate angle, which is the rightward angle, is the left home position.
If
When the right rotate operation is synchronized while performing the left shift operation from the right home position to the left home position, or when the right shift operation is performed from the left home position to the right home position, the left When the rotation operations are synchronized, the shift-related amount related to the shift position is set corresponding to the rotation angle in, and the rotation angle and the shift-related amount in which the fork protrudes to the left and right from the width of the vehicle body are set. The synchronization reference characteristic in which the area is set as the prohibited area is stored in the storage device in advance.
The control when the operating means is operated and a right home position instruction for setting the fork state to the right home position or a left home position instruction for setting the fork state to the left home position is input. In the device
The current fork state, which is the current fork state based on the current rotate angle, which is the current rotation angle of the fork, and the current shift-related amount, which is the shift-related amount corresponding to the current shift position of the fork, is the current fork state. A confirmation step in the prohibited area for determining whether or not it is in the prohibited area in the synchronization reference characteristic, and
When it is determined that the current fork state is within the prohibited area, the rotation operation prohibition step for prohibiting the control of the rotate drive device and the rotation operation prohibition step
Have a,
In the control device
When it is determined in the prohibited area confirmation step that the current fork state is within the prohibited area, the direction of the shift operation toward the target shift-related amount obtained based on the operating state of the operating means is the prohibited area. When it is determined that the direction is to escape from, the shift drive device is feedback-controlled so that the current shift-related amount approaches the target shift-related amount, and the direction of the shift operation toward the target shift-related amount is the said. When it is determined that the vehicle is not in the direction of escaping from the prohibited area, it has a prohibited area escape shift control step for stopping the feedback control of the shift drive device.
In the control device
After executing the prohibited area escape shift control step, when it is determined in the prohibited area confirmation step that the current fork state is not within the prohibited area,
Target rotation angle obtained by adding the addition rotation angle obtained based on the operating state of the operating means to the current rotation angle or the synchronization rotation angle which is the rotation angle obtained based on the synchronization reference characteristic and the current shift-related amount. The target rotation angle calculation step and
A rotation feedback control step that feedback-controls the rotation drive device so that the current rotation angle approaches the target rotation angle.
The addition shift-related amount obtained based on the operating state of the operating means is added to the synchronization shift-related amount, which is the shift-related amount obtained based on the synchronization reference characteristic and the current rotation angle, or the current shift-related amount. The target shift-related amount calculation step to obtain the target shift-related amount, and
A shift feedback control step that feedback-controls the shift drive device so that the current shift-related amount approaches the target shift-related amount.
Have,
Forklift cargo handling control method.
前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、
前記フォークの向きを車体の前進方向とした場合のローテート角度を0°、
前記フォークの向きを前記左向き角度とした場合のローテート角度を−90°、
前記フォークの向きを前記右向き角度とした場合のローテート角度を+90°、
と設定し、
前記シフト関連量には、
シフト位置を角度に換算した換算角度を設定し、
前記左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置を、換算角度0°、
前記右シフト限界位置となるシフト位置を、換算角度+90°、
前記左シフト限界位置となるシフト位置を、換算角度−90°、
と設定し、
前記左シフト限界位置から前記右シフト限界位置に至るまでの各シフト位置を、換算角度−90°から換算角度+90°の範囲内において対応する換算角度に設定する、
フォークリフトの荷役制御方法。 The forklift cargo handling control method according to claim 1.
The fork can perform the right rotate operation from the left angle to the right angle, can perform the left rotate operation from the right angle to the left angle, and can shift to the right from the left shift limit position. The right shift operation is possible to the limit position, and the left shift operation is possible from the right shift limit position to the left shift limit position.
When the direction of the fork is the forward direction of the vehicle body, the rotation angle is 0 °.
When the fork is oriented to the left, the rotation angle is −90 °.
When the fork is oriented to the right, the rotation angle is + 90 °.
And set
The shift-related amount includes
Set the conversion angle that converts the shift position to the angle,
The central shift position from the left shift limit position to the right shift limit position is defined by a conversion angle of 0 °.
The shift position, which is the right shift limit position, is set to a conversion angle of + 90 °.
The shift position, which is the left shift limit position, is set to a conversion angle of −90 °.
And set
Each shift position from the left shift limit position to the right shift limit position is set to the corresponding conversion angle within the range of the conversion angle −90 ° to the conversion angle + 90 °.
Forklift cargo handling control method.
車体に対して前記フォークを右回りに旋回させる右ローテート動作、及び車体に対して前記フォークを左回りに旋回させる左ローテート動作、を行うローテート駆動装置と、
車体に対する前記フォークの旋回角度であるローテート角度を検出するローテート角度検出手段と、
車体の左右方向における前記フォークの位置であるシフト位置を検出するシフト位置検出手段と、
操作手段と、
前記操作手段の操作状態を検出する操作状態検出手段と、
を有するフォークリフトにおける前記右シフト動作、前記左シフト動作、前記右ローテート動作、前記左ローテート動作を制御する、フォークリフトの荷役制御装置であって、
記憶装置と、
制御装置と、
を有し、
前記フォークを右移動させた際のシフト位置の限界である右シフト限界位置、かつ前記フォークを左旋回させた際に前記フォークが車体の前進方向に対して直交する左方向を向いたローテート角度である左向き角度、となるシフト位置及びローテート角度の前記フォークの状態を右ホームポジション、
前記フォークを左移動させた際のシフト位置の限界である左シフト限界位置、かつ前記フォークを右旋回させた際に前記フォークが車体の前進方向に対して直交する右方向を向いたローテート角度である右向き角度、となるシフト位置及びローテート角度の前記フォークの状態を左ホームポジション、
とした場合、
前記記憶装置には、
前記右ホームポジションから前記左ホームポジションへと前記左シフト動作を行いながら前記右ローテート動作を同期させた際、あるいは、前記左ホームポジションから前記右ホームポジションへと前記右シフト動作を行いながら前記左ローテート動作を同期させた際、におけるローテート角度に対応させて、シフト位置に関連するシフト関連量が設定されているとともに、前記フォークが車体の幅よりも左右に突出するローテート角度及びシフト関連量となる領域が禁止領域として設定された、同期基準特性が記憶されており、
前記制御装置は、
前記操作状態検出手段からの検出信号に基づいて、前記操作手段の操作状態である操作手段操作状態を検出し、
前記ローテート角度検出手段からの検出信号に基づいて、現在の前記フォークのローテート角度である現在ローテート角度を求め、
前記シフト位置検出手段からの検出信号に基づいて、現在の前記フォークのシフト位置に対応するシフト関連量を求め、
前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、
現在の前記フォークのローテート角度である現在ローテート角度と、現在の前記フォークのシフト位置に対応するシフト関連量である現在シフト関連量と、に基づいた現在のフォークの状態である現在フォーク状態が、前記同期基準特性における前記禁止領域内であるか否かを判定し、
前記現在フォーク状態が前記禁止領域内であると判定した場合、前記ローテート駆動装置の制御を禁止し、
前記制御装置は、
前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、
前記現在フォーク状態が前記禁止領域内であると判定した際、
前記操作手段操作状態に基づいて目標シフト関連量を求め、
求めた前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向であると判定した場合は、前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御し、前記目標シフト関連量に向かうシフト動作の方向が、前記禁止領域から脱出する方向でないと判定した場合は、前記シフト駆動装置のフィードバック制御を中止し、
前記制御装置は、
前記操作手段操作状態が、前記フォークの状態を前記右ホームポジションにする右ホームポジション指示、あるいは前記フォークの状態を前記左ホームポジションにする左ホームポジション指示、である場合、
前記現在フォーク状態が前記禁止領域内でないと判定した際、
前記現在ローテート角度、あるいは前記同期基準特性と前記現在シフト関連量に基づいて求めたローテート角度である同期ローテート角度に、前記操作手段操作状態に基づいて求めた加算ローテート角度を加算した目標ローテート角度を求め、
前記現在ローテート角度が前記目標ローテート角度に近づくように前記ローテート駆動装置をフィードバック制御し、
前記同期基準特性と前記現在ローテート角度に基づいて求めたシフト関連量である同期シフト関連量、あるいは前記現在シフト関連量に、前記操作手段操作状態に基づいて求めた加算シフト関連量を加算した目標シフト関連量を求め、
前記現在シフト関連量が前記目標シフト関連量に近づくように前記シフト駆動装置をフィードバック制御する、
フォークリフトの荷役制御装置。 A shift drive device that performs a right shift operation for moving the fork to the right with respect to the vehicle body and a left shift operation for moving the fork to the left with respect to the vehicle body.
A rotation drive device that performs a right-rotate operation of turning the fork clockwise with respect to the vehicle body and a left-rotate operation of turning the fork counterclockwise with respect to the vehicle body.
Rotate angle detecting means for detecting the rotate angle, which is the turning angle of the fork with respect to the vehicle body,
A shift position detecting means for detecting a shift position which is the position of the fork in the left-right direction of the vehicle body,
Operation means and
An operation state detecting means for detecting the operation state of the operation means and
A forklift cargo handling control device that controls the right shift operation, the left shift operation, the right rotate operation, and the left rotate operation in the forklift having the above.
Storage device and
Control device and
Have,
At the right shift limit position, which is the limit of the shift position when the fork is moved to the right, and at the rotation angle when the fork is oriented to the left orthogonal to the forward direction of the vehicle body when the fork is turned to the left. The state of the fork at a certain leftward angle, a shift position and a rotate angle, is a right home position.
The left shift limit position, which is the limit of the shift position when the fork is moved to the left, and the rotation angle when the fork is oriented to the right orthogonal to the forward direction of the vehicle body when the fork is turned to the right. The state of the fork at the shift position and the rotate angle, which is the rightward angle, is the left home position.
If
The storage device has
When the right rotate operation is synchronized while performing the left shift operation from the right home position to the left home position, or when the right shift operation is performed from the left home position to the right home position, the left When the rotation operations are synchronized, the shift-related amount related to the shift position is set corresponding to the rotation angle in, and the rotation angle and the shift-related amount in which the fork protrudes to the left and right from the width of the vehicle body are set. The synchronization reference characteristic is stored in which the area is set as the prohibited area.
The control device is
Based on the detection signal from the operation state detecting means, the operation means operation state which is the operation state of the operation means is detected, and the operation state is detected.
Based on the detection signal from the rotation angle detecting means, the current rotation angle, which is the current rotation angle of the fork, is obtained.
Based on the detection signal from the shift position detecting means, the shift-related amount corresponding to the current shift position of the fork is obtained.
When the operating means operating state is a right home position instruction that sets the fork state to the right home position, or a left home position instruction that sets the fork state to the left home position.
The current fork state, which is the current fork state based on the current rotate angle, which is the current rotation angle of the fork, and the current shift-related amount, which is the shift-related amount corresponding to the current shift position of the fork, is the current fork state. It is determined whether or not it is within the prohibited area in the synchronization reference characteristic, and it is determined.
When it is determined that the current fork state is within the prohibited area, the control of the rotate drive device is prohibited .
The control device is
When the operating means operating state is a right home position instruction that sets the fork state to the right home position, or a left home position instruction that sets the fork state to the left home position.
When it is determined that the current fork state is within the prohibited area,
The target shift-related amount is obtained based on the operating state of the operating means.
When it is determined that the direction of the shift operation toward the obtained target shift-related amount is the direction of escaping from the prohibited region, the shift drive device is set so that the current shift-related amount approaches the target shift-related amount. When feedback control is performed and it is determined that the direction of the shift operation toward the target shift-related amount is not the direction of escaping from the prohibited region, the feedback control of the shift drive device is stopped.
The control device is
When the operating means operating state is a right home position instruction that sets the fork state to the right home position, or a left home position instruction that sets the fork state to the left home position.
When it is determined that the current fork state is not within the prohibited area,
A target rotation angle obtained by adding the addition rotation angle obtained based on the operating state of the operating means to the current rotation angle or the synchronization rotation angle which is the rotation angle obtained based on the synchronization reference characteristic and the current shift-related quantity. Ask,
The rotation drive device is feedback-controlled so that the current rotation angle approaches the target rotation angle.
A target obtained by adding an additional shift-related amount obtained based on the operating state of the operating means to the synchronous shift-related amount, which is a shift-related amount obtained based on the synchronization reference characteristic and the current rotation angle, or the current shift-related amount. Find the shift-related quantity,
The shift drive device is feedback-controlled so that the current shift-related amount approaches the target shift-related amount.
Forklift cargo handling control device.
前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、
前記フォークの向きを車体の前進方向とした場合のローテート角度は0°、
前記フォークの向きを前記左向き角度とした場合のローテート角度は−90°、
前記フォークの向きを前記右向き角度とした場合のローテート角度は+90°、
と設定されており、
前記シフト関連量には、
シフト位置を角度に換算した換算角度が設定されており、
前記左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置は、換算角度0°、
前記右シフト限界位置となるシフト位置は、換算角度+90°、
前記左シフト限界位置となるシフト位置は、換算角度−90°、
と設定されており、
前記左シフト限界位置から前記右シフト限界位置に至るまでの各シフト位置は、換算角度−90°から換算角度+90°の範囲内において対応する換算角度に設定されている、
フォークリフトの荷役制御装置。
The forklift cargo handling control device according to claim 3.
The fork can perform the right rotate operation from the left angle to the right angle, can perform the left rotate operation from the right angle to the left angle, and can shift to the right from the left shift limit position. The right shift operation is possible to the limit position, and the left shift operation is possible from the right shift limit position to the left shift limit position.
When the direction of the fork is the forward direction of the vehicle body, the rotation angle is 0 °.
When the fork is oriented to the left, the rotation angle is −90 °.
When the fork is oriented to the right, the rotation angle is + 90 °.
Is set to
The shift-related amount includes
The conversion angle that converts the shift position to the angle is set,
The central shift position from the left shift limit position to the right shift limit position has a conversion angle of 0 °.
The shift position, which is the right shift limit position, is a conversion angle of + 90 °.
The shift position, which is the left shift limit position, has a conversion angle of −90 °.
Is set to
Each shift position from the left shift limit position to the right shift limit position is set to a corresponding conversion angle within a range of the conversion angle −90 ° to the conversion angle + 90 °.
Forklift cargo handling control device.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017186621A JP6922613B2 (en) | 2017-09-27 | 2017-09-27 | Forklift cargo handling control method and forklift cargo handling control device |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2017186621A JP6922613B2 (en) | 2017-09-27 | 2017-09-27 | Forklift cargo handling control method and forklift cargo handling control device |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JP2019059603A JP2019059603A (en) | 2019-04-18 |
| JP6922613B2 true JP6922613B2 (en) | 2021-08-18 |
Family
ID=66177050
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP2017186621A Active JP6922613B2 (en) | 2017-09-27 | 2017-09-27 | Forklift cargo handling control method and forklift cargo handling control device |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JP6922613B2 (en) |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS5440820B2 (en) * | 1975-02-07 | 1979-12-05 | ||
| DE4412442B4 (en) * | 1994-04-12 | 2006-05-11 | Dambach Lagersysteme Gmbh | Method for controlling the movements of a pan-push unit of a stacker crane |
| DE29802498U1 (en) * | 1998-02-13 | 1998-04-16 | Heilmeier & Weinlein | Forklift control |
| JP2003212491A (en) * | 2002-01-28 | 2003-07-30 | Komatsu Forklift Co Ltd | Fork automatic reverse control device for forklift |
| JP2005082287A (en) * | 2003-09-05 | 2005-03-31 | Nippon Yusoki Co Ltd | Automatic swiveling device for fork |
| JP4578859B2 (en) * | 2004-05-26 | 2010-11-10 | 日本輸送機株式会社 | Fork swing prevention device |
-
2017
- 2017-09-27 JP JP2017186621A patent/JP6922613B2/en active Active
Also Published As
| Publication number | Publication date |
|---|---|
| JP2019059603A (en) | 2019-04-18 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20180134531A1 (en) | Forklift | |
| CN104428192B (en) | Steering system for vehicle and steering method for vehicle | |
| JP5972081B2 (en) | One-side welding equipment for bent plate | |
| JP5596442B2 (en) | Aerial work platform | |
| JPWO2019039546A1 (en) | Remote control device | |
| JP6922613B2 (en) | Forklift cargo handling control method and forklift cargo handling control device | |
| JP6874623B2 (en) | Forklift cargo handling control method and forklift cargo handling control device | |
| JP2009288872A (en) | Operation apparatus | |
| JP2010083467A (en) | Movable working platform | |
| CN100415631C (en) | tire transport forklift | |
| JP6634956B2 (en) | Travel control device for industrial vehicles | |
| JP2020083572A (en) | Driving support device for forklift truck | |
| JP2010260698A (en) | Boom work vehicle operation control device | |
| JP3690654B2 (en) | Cargo handling vehicle | |
| JP7165640B2 (en) | working machine | |
| JP5944722B2 (en) | Aerial work platform | |
| JP4788412B2 (en) | Inverted pendulum type moving body | |
| JP5144894B2 (en) | Joystick device | |
| JP6255617B2 (en) | Manned and unmanned forklift | |
| JP2004189194A (en) | Display device of forklift | |
| JP5942484B2 (en) | Lift truck | |
| JP6115970B2 (en) | FORK CONTROL DEVICE, REACH FORKLIFT, FORK CONTROL METHOD AND FORK CONTROL PROGRAM | |
| JP5873906B1 (en) | Reach forklift | |
| JPH1159474A (en) | Reach-type forklift | |
| JP7035784B2 (en) | Traveling trolley |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20200306 |
|
| A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20210204 |
|
| A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20210406 |
|
| A521 | Written amendment |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20210527 |
|
| 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: 20210629 |
|
| A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20210712 |
|
| R151 | Written notification of patent or utility model registration |
Ref document number: 6922613 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |