Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP6922613B2 - Forklift cargo handling control method and forklift cargo handling control device - Google Patents
[go: Go Back, main page]

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 PDF

Info

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
Application number
JP2017186621A
Other languages
Japanese (ja)
Other versions
JP2019059603A (en
Inventor
琢 水城
琢 水城
佐藤 真也
真也 佐藤
田中 博之
博之 田中
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Industries Corp
Original Assignee
Toyota Industries Corp
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Toyota Industries Corp filed Critical Toyota Industries Corp
Priority to JP2017186621A priority Critical patent/JP6922613B2/en
Publication of JP2019059603A publication Critical patent/JP2019059603A/en
Application granted granted Critical
Publication of JP6922613B2 publication Critical patent/JP6922613B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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 Patent Document 1 has a relative positional relationship curve shown in FIG. 20. In the relative positional relationship curve shown in FIG. 20, the horizontal axis indicates the rotation angle R of the fork. Equivalent), indicating that it is in the state of. Further, in the relative positional relationship curve, the vertical axis indicates the fork shift position M, the fork shift position is at the left end (corresponding to the left shift limit position) at the lower end, and the fork shift position is at the right end (right shift limit) at the upper end. (Corresponding to the position), indicating that. Further, the shaded hatched portion indicates an interference region Rc in which the fork interferes with the rack, and the center line C approximates a curve centered on the limit lines (boundary lines) Lc1 and Lc2 of the interference region Rc with a plurality of straight lines. It is a line that has been made. Further, in the non-interference region NRc, which is a region other than the interference region Rc, an allowable region Rf indicated by vertical line hatching, which includes the center line C and further narrows the non-interference region NRc, is set. In FIG. 20, a region that is not an interference region Rc and a region that is not an allowable region Rf (a region in FIG. 20 in which neither diagonal line hatching nor vertical line hatching is performed) is defined as a non-allowable region NRf.

引用文献1では、フォーク状態(ローテート角度、シフト位置)が、図20中における許容領域Rf内の場合、シフト動作とローテート動作の同期制御を実行可能である。また、同期操作を実行する際、オペレータは、ボタンを操作し、かつローテートレバーを操作することで、同期動作を指示する。また、フォーク状態(ローテート角度、シフト位置)が、図20中における非許容領域NRf内の場合(例えば図20中のP1(R1、M1)等の場合)、フォーク状態(ローテート角度、シフト位置)に応じて、ローテート動作またはシフト動作の一方を行って、フォーク状態(ローテート角度、シフト位置)を、非許容領域NRfから許容領域Rfへと旋回・移動させ、許容領域Rf内に入った後は、シフト動作とローテート動作の同期制御へ移行している。なお、フォーク状態(ローテート角度、シフト位置)が干渉領域Rc内にある場合では、エラーを表示手段に表示して、フォークの制御を停止している。なお、通常の搬入・搬出作業(荷役作業)は、フォークのローテート角度を、フォークリフトの前進方向に直交する右向き角度または左向き角度にして、フォークを左右にシフト動作させる。従って、フォークのローテート角度が、フォークリフトの前進方向に直交する右向き角度または左向き角度の場合は、干渉領域Rc内であってもシフト動作は可能とされている。 In Cited Document 1, when the fork state (rotate angle, shift position) is within the allowable region Rf in FIG. 20, synchronous control of the shift operation and the rotate operation can be executed. Further, when executing the synchronization operation, the operator instructs the synchronization operation by operating the button and operating the rotate lever. Further, when the fork state (rotate angle, shift position) is within the unacceptable region NRf in FIG. 20 (for example, in the case of P1 (R1, M1) in FIG. 20), the fork state (rotate angle, shift position). Depending on the situation, either the rotate operation or the shift operation is performed to rotate and move the fork state (rotate angle, shift position) from the non-allowable region NRf to the allowable region Rf, and after entering the allowable region Rf. , Shifting to synchronous control of shift operation and rotate operation. When the fork state (rotate angle, shift position) is within the interference region Rc, an error is displayed on the display means and the fork control is stopped. In normal loading / unloading work (cargo handling work), the fork is shifted to the left or right by setting the fork rotation angle to a rightward angle or a leftward angle orthogonal to the forward direction of the forklift. Therefore, when the rotation angle of the fork is a rightward angle or a leftward angle orthogonal to the forward direction of the forklift, the shift operation is possible even within the interference region Rc.

特開2002−293497号公報JP-A-2002-293497

左ラックと右ラックに挟まれた通路内に入ったフォークリフトは、左ラックに対して荷役作業を行う際、左に向けたフォークを左シフト動作させて干渉領域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 Patent Document 1, for example, if the operator inadvertently operates the rotate lever during loading or unloading, the operation of the fork stops in the interference region Rc and the fork operates in the interference region Rc. It is not preferable because the fork may be out of control.

本発明は、このような点に鑑みて創案されたものであり、フォークを右向きまたは左向きにして左右にシフト動作させる搬入時・搬出時(荷役作業時)を除き、フォークが干渉領域(禁止領域)内に入っている場合、安全に干渉領域(禁止領域)から脱出できるように支援する、フォークリフトの荷役制御方法及びフォークリフトの荷役制御装置を提供することを課題とする。 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.

本発明を適用したフォークリフトの外観の例を示す斜視図である。It is a perspective view which shows the example of the appearance of the forklift to which this invention is applied. 図1に示したフォークリフトの右側面図である。It is a right side view of the forklift shown in FIG. 図1に示したフォークリフトにおいて、オペレータが操作する各レバーの例を説明する斜視図である。It is a perspective view explaining an example of each lever operated by an operator in the forklift shown in FIG. 左右をラックに囲まれた通路内において、フォークの旋回と移動をさせた場合の例を説明する平面図である。It is a top view explaining the example of the case where the fork is swiveled and moved in the passage surrounded by racks on the left and right sides. フォークのローテート角度を+90[°](右向き)にした状態、かつ、フォークのシフト位置を左シフト限界位置にした状態である、左ホームポジションを説明する平面図である。It is a top view explaining the left home position which is the state which the rotation angle of a fork is set to +90 [°] (to the right), and the shift position of a fork is set to the left shift limit position. フォークのローテート角度を0[°](正面方向)にした状態、かつ、フォークのシフト位置をシフト範囲の中央にした状態である、中央ホームポジションを説明する平面図である。It is a top view explaining the central home position which is the state where the rotation angle of a fork is set to 0 [°] (front direction), and the shift position of a fork is set to the center of a shift range. フォークのローテート角度を−90[°](左向き)にした状態、かつ、フォークのシフト位置を右シフト限界位置にした状態である、右ホームポジションを説明する平面図である。It is a top view explaining the right home position which is the state which the fork rotation angle is set to −90 [°] (leftward), and the state which the fork shift position is set to the right shift limit position. 機台制御装置の入出力を説明する図である。It is a figure explaining the input / output of the machine stand control device. 機台制御装置の第1の実施の形態の処理手順の例であって、現在フォーク状態が禁止領域内に入っている場合における処理手順の例を説明するフローチャートである。It is an example of the processing procedure of the 1st Embodiment of the machine stand control device, and is the flowchart explaining the example of the processing procedure at the time when the fork state is currently in a prohibition area. 機台制御装置の第1の実施の形態の処理手順の例であって、現在フォーク状態が禁止領域内に入っていない場合における処理手順の例を説明するフローチャートである。It is an example of the processing procedure of the 1st Embodiment of the machine stand control device, and is the flowchart explaining the example of the processing procedure at the time when the fork state is not in the prohibition area at present. フォークの左右方向におけるシフト位置を、シフト関連量(換算角度)へと換算するシフト位置・換算角度特性の例と、シフト関連量(換算角度)を説明する図である。It is a figure explaining the example of the shift position / conversion angle characteristic which converts the shift position in the left-right direction of a fork into a shift-related amount (conversion angle), and the shift-related amount (conversion angle). ローテート角度を説明する図である。It is a figure explaining the rotation angle. 操作レバー(操作手段)を左右に操作した場合における、操作量に応じた加算シフト関連量が設定された、左右操作量・加算シフト関連量特性の例を説明する図である。It is a figure explaining the example of the left-right operation amount / addition shift-related quantity characteristic in which the addition shift-related quantity corresponding to the operation amount is set when the operation lever (operation means) is operated left and right. 操作レバー(操作手段)を前後に操作した場合における、操作量に応じた加算ローテート量が設定された、前後操作量・加算ローテート量特性の例を説明する図である。It is a figure explaining the example of the back-and-forth operation amount / addition rotation amount characteristic that the addition rotation amount is set according to the operation amount when the operation lever (operation means) is operated back and forth. 操作レバー(操作手段)を前後に操作した場合における、操作量に応じた加算シフト関連量が設定された、前後操作量・加算シフト関連量特性の例を説明する図である。It is a figure explaining the example of the back-and-forth operation amount / addition shift-related quantity characteristic in which the addition shift-related quantity corresponding to the operation amount is set when the operation lever (operation means) is operated back and forth. 右ホームポジションから左ホームポジション、あるいは左ホームポジションから右ホームポジションへと遷移する際の、ローテート角度とシフト関連量(換算角度)の同期関係を示すシフト・ローテート同期基準特性の例、及び禁止領域の例と、第1の実施の形態において、現在フォーク状態が禁止領域内に入っていない場合における動作の例を説明する図である。An example of the shift / rotate synchronization reference characteristic showing the synchronization relationship between the rotation angle and the shift-related amount (conversion angle) when transitioning from the right home position to the left home position or from the left home position to the right home position, and the prohibited area. This is a diagram for explaining an example of the operation when the fork state is not currently in the prohibited area in the first embodiment. 第1の実施の形態において、現在フォーク状態が禁止領域内に入っている場合における動作の例を説明する図である。In the first embodiment, it is a figure explaining an example of operation when the fork state is present in a prohibition area. 機台制御装置の第2の実施の形態の処理手順の例であって、現在フォーク状態が禁止領域内に入っていない場合における処理手順の例を説明するフローチャートである。It is an example of the processing procedure of the 2nd Embodiment of the machine stand control device, and is the flowchart explaining the example of the processing procedure at the time when the fork state is not in the prohibition area at present. 第2の実施の形態において、現在フォーク状態が禁止領域内に入っていない場合における動作の例を説明する図である。In the second embodiment, it is a figure explaining the example of the operation when the fork state is not in the prohibition area at present. 従来の禁止領域の例と、従来のフォークの動作の例を説明する図である。It is a figure explaining the example of the conventional prohibited area and the example of the operation of the conventional fork.

以下に本発明を実施するための形態を図面を用いて説明する。なお、図中に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 forklift 1 is "right shift operation", and the fork 35 (arm 32) is moved to the forklift 1 with respect to the forklift 1. The operation of moving to the left is described as "left shift operation". Similarly, when the operator in the driver's seat views the fork from above, the operation of turning the fork 35 clockwise with respect to the vehicle body of the forklift 1 is the "right rotation operation", and the fork 35 with respect to the vehicle body of the forklift 1. The operation of turning the counterclockwise is described as "left rotation operation". Further, the "shift operation" includes a right shift operation and a left shift operation, and the "rotate operation" includes a right rotate operation and a left rotate operation. Similarly, when the operator in the driver's seat views the fork from above, the turning angle of the fork 35 with respect to the forklift 1 is the "rotate angle", and the position of the fork 35 (arm 32) in the left-right direction of the forklift 1 is the "shift position". ".

●[フォークリフト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 forklift 1 described in the present embodiment includes a vehicle body 10, a mast 20, an elevating unit 30, a drive steering wheel 16A, a caster wheel 16B, a driven wheel 16C, and the like. .. The vehicle body 10 has a body 11, a reach leg 12 (see FIG. 4), a head guard 13, and the like. In the description of the present embodiment, each motor is an electric motor that operates with the electric power supplied from the battery 50.

ボディ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 body 11 has a box shape having a floor surface on which an operator rides, and is provided with drive steering wheels 16A and caster wheels 16B so as to project downward from the rear. Further, on the left and right sides of the body 11, a pair of reach legs 12 projecting forward are provided on the left and right sides, and a head guard 13 is provided above the body 11. A driving wheel 16C is provided on each of the left and right reach legs 12 so as to project downward, and the plate-shaped cross plate 17 is supported by the left and right reach legs 12. The cross plate 17 is provided with a mast 20. Further, a rear roller 14 (see FIG. 6) is provided on the lower rear side surface of the body 11 so as to project left and right, and a front roller 15 (see FIG. 6) is provided on the front side surface of the reach leg 12 so as to project left and right. See). As shown in FIG. 6, the front roller 15 and the rear roller 14 have a function of guiding the forklift by contacting the left and right racks with the forklift that has entered the passage T having the passage width L.

ボディ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 operation lever 41, an elevating lever 42, an accelerator lever 43, a steering 45, a special button 44 (see FIG. 3), and the like are provided at a position (driver's seat) on the body 11 where the operator is boarded. The operator operates these levers to run and handle cargo. The operation lever 41 corresponds to the operation means. Further, the floor surface of the body 11 is provided with a so-called deadman type foot brake (not shown) or the like in which the brake is released when the operator steps on it. Further, a battery 50, a traveling motor 16M, a machine base control device 40 (corresponding to a control device), and the like are housed in the body 11. The operator can move the forklift 1 forward and backward by the drive steering wheel 16A by operating the accelerator lever 43 and depressing the foot brake (release the brake), and by operating the steering wheel 45, the drive steering wheel can be moved forward and backward. The direction of 16A can be changed to make a right turn or a left turn of the forklift 1.

マスト20は、図1に示すように、クロスプレート17に設けられている。またマスト20は、クロスプレート17に接続されたアウタマスト21と、アウタマスト21に対して上下にスライド可能なインナマスト22を有している。インナマスト22には、昇降ユニット30を上下に昇降可能とするリフトシリンダが取り付けられている。昇降ユニット30は、車体に設けられた昇降モータ30Mがオイルポンプを駆動することにより、オイルがリフトシリンダへ供給されることによって昇降する。オペレータは、昇降レバー42を操作することで、昇降ユニット30の昇降を指示することができる。 The mast 20 is provided on the cross plate 17 as shown in FIG. Further, the mast 20 has an outer mast 21 connected to the cross plate 17 and an inner mast 22 that can slide up and down with respect to the outer mast 21. The inner mast 22 is equipped with a lift cylinder that allows the elevating unit 30 to be raised and lowered up and down. The elevating unit 30 moves up and down by supplying oil to the lift cylinder by driving an oil pump by an elevating motor 30M provided on the vehicle body. The operator can instruct the elevating unit 30 to elevate and lower by operating the elevating lever 42.

昇降ユニット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 unit 30 is vertically movablely attached to the inner mast 22, and has a support portion 36, a shift rail 31, an arm 32, a rotate shaft 33, a finger bar 34, a fork 35, and the like. There is. The shift rail 31 is a pair of vertically extending rails extending in the left-right direction, and guides the movement of the arm 32 in the left-right direction. Further, the shift rail 31 is attached so as to be movable up and down with respect to the inner mast 22 via the support portion 36. The arm 32 is attached so as to be movable left and right with respect to the shift rail 31, and a rotate shaft 33 capable of turning left and right around the rotation axis 33Z is provided at the tip of the arm 32. A finger bar 34 is attached to the rotate shaft 33, and a fork 35 is attached to the finger bar 34.

アーム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 arm 32 is provided with a shift motor 31M, a shift roller 31R, a shift position detecting means 31S, a rotate motor 33M, a rotate angle detecting means 33S, and the like. The shift motor 31M corresponds to a shift drive device, and rotates the shift roller 31R via a power transmission means such as a gear based on a control signal from the machine base control device 40. The shift roller 31R is in contact with the shift rail 31, and when the shift roller 31R rotates, the arm 32 moves left and right along the shift rail 31. The shift position detecting means 31S is, for example, a position sensor, and outputs a detection signal corresponding to the position of the arm 32 in the left-right direction with respect to the shift rail 31 to the machine stand control device 40.

ローテートモータ33Mは、ローテート駆動装置に相当しており、機台制御装置40からの制御信号に基づいて、ギア等の動力伝達手段を介してローテートシャフト33を回転軸線33Z回りに旋回させる。ローテート角度検出手段33Sは、例えば角度センサであり、アーム32に対するローテートシャフト33の旋回角度に応じた検出信号を機台制御装置40に出力する。オペレータは、操作レバー41を左右に傾斜させることで、アーム32を左右にシフト移動させることができる。またオペレータは、操作レバー41を前傾させることで、アーム32及びフォーク35を図5に示す左ホームポジションへと移動させることができる。またオペレータは、操作レバー41を後傾させることで、アーム32及びフォーク35を図7に示す右ホームポジションへと移動させることができる。 The rotate motor 33M corresponds to a rotate drive device, and rotates the rotate shaft 33 around the rotation axis 33Z via a power transmission means such as a gear based on a control signal from the machine base control device 40. The rotate angle detecting means 33S is, for example, an angle sensor, and outputs a detection signal corresponding to the turning angle of the rotate shaft 33 with respect to the arm 32 to the machine stand control device 40. The operator can shift the arm 32 to the left or right by tilting the operation lever 41 to the left or right. Further, the operator can move the arm 32 and the fork 35 to the left home position shown in FIG. 5 by tilting the operating lever 41 forward. Further, the operator can move the arm 32 and the fork 35 to the right home position shown in FIG. 7 by tilting the operating lever 41 backward.

バッテリ50は、例えば鉛蓄バッテリ(鉛蓄電池)であり、バッテリ50から、各モータや機台制御装置40に電力が供給される。 The battery 50 is, for example, a lead storage battery (lead storage battery), and power is supplied from the battery 50 to each motor and the chassis control device 40.

次に図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 operation lever 41, an elevating lever 42, an accelerator lever 43, a special button 44, a monitor 47, an audio output device 48, a lamp 49, and the like are arranged on the operation panel.

操作レバー41は、直立した中立位置に保持されており、中立位置から前後方向へ、あるいは中立位置から左右方向へと傾倒可能とされている。操作レバー41の近傍には、操作状態検出手段41Sが設けられており、機台制御装置40は、操作状態検出手段41Sからの検出信号に基づいて、操作レバー41が、中立位置であるか、前後左右のどの方向に傾倒されているか、傾倒されている場合の操作量(操作角度(=傾倒角度))はどれくらいか、を検出可能である。オペレータが操作レバー41を右に傾倒させると、アーム32が右にシフト移動し、オペレータが操作レバー41を左に傾倒させると、アーム32が左にシフト移動する(図4参照)。 The operating lever 41 is held in an upright neutral position, and can be tilted from the neutral position to the front-rear direction or from the neutral position to the left-right direction. An operation state detecting means 41S is provided in the vicinity of the operation lever 41, and the machine base control device 40 determines whether the operation lever 41 is in the neutral position based on the detection signal from the operation state detection means 41S. It is possible to detect in which direction the tilt is forward, backward, left or right, and how much the operation amount (operation angle (= tilt angle)) when tilted is. When the operator tilts the operating lever 41 to the right, the arm 32 shifts to the right, and when the operator tilts the operating lever 41 to the left, the arm 32 shifts to the left (see FIG. 4).

[左ホームポジション(図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 lever 41 forward is a left home position instruction for moving the fork 35 to the left home position shown in FIG. 5, and moves the fork 35 to the left home position by synchronizing the left shift operation and the right rotate operation. It is an instruction to let you. When the operator tilts the operation lever 41 forward, the arm 32 shifts to the left while the fork 35 turns to the right around the rotation axis 33Z, and the left home position (arm 32 is the left shift limit position and the arm 32 is the left shift limit position) shown in FIG. , The fork 35 has a rightward angle). The left shift limit position of the arm 32 is a position that becomes the limit of the shift position when the fork 35 (arm 32) is operated to the left shift (in the example of FIG. 11, the shift-related amount (converted angle) = −90 [ °] position). Further, the right-facing angle of the fork 35 is a rotation angle in which the fork 35 faces the right direction orthogonal to the forward direction of the forklift 1 when the fork 35 is rotated to the right (in the example of FIG. 12, the rotation angle). = +90 [°] angle).

[右ホームポジション(図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 operation lever 41 is a right home position instruction for moving the fork 35 to the right home position shown in FIG. 7, and moves to the right home position by synchronizing the right shift operation and the left rotate operation. It is an instruction to let you. When the operator tilts the operating lever 41 backward, the arm 32 shifts to the right while the fork 35 turns left around the rotation axis 33Z, and the right home position (arm 32 is the right shift limit position and the arm 32 is the right shift limit position) shown in FIG. The fork 35 has a leftward angle). The right shift limit position of the arm 32 is a position that becomes the limit of the shift position when the fork 35 (arm 32) is moved to the right (in the example of FIG. 11, the shift-related amount (converted angle) = +90 [°]. ] Position). Further, the leftward angle of the fork 35 is a rotation angle in which the fork 35 faces the left direction orthogonal to the forward direction of the fork lift 1 when the fork 35 is rotated to the left (in the example of FIG. 12, the rotation angle). = -90 [°] angle).

[中央ホームポジション(図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 arm 32 is at the center position in the left-right direction (in the example of FIG. 11, the shift-related amount (converted angle) = 0 [°] position) and the fork 35 is facing forward (FIG. 12). In the example, the central home position where the rotation angle = 0 [°] angle) is shown. For example, when the arm 32 and the fork 35 are in the left home position shown in FIG. 5, when the operator tilts the operation lever 41 backward, the fork 35 turns to the left while the arm 32 shifts to the right, and the arm 32 And the fork 35 becomes the right home position shown in FIG. 7 after passing through the central home position shown in FIG. When the operator desires only the turning operation of the fork 35, the operator can turn the fork 35 to the right by tilting the operation lever 41 forward while pressing the special button 44, and the special button 44 can be turned. The fork 35 can be turned to the left by tilting the operating lever 41 backward while pressing the lever.

昇降レバー42は、直立した中立位置に保持されており、中立位置から前後方向へと傾倒可能とされている。昇降レバー42の近傍には、昇降操作状態検出手段42Sが設けられており、機台制御装置40は、昇降操作状態検出手段42Sからの検出信号に基づいて、昇降レバー42が、中立位置であるか、前後のどちらの方向に傾倒されているか、傾倒されている場合の操作量(操作角度)はどれくらいか、を検出可能である。オペレータが昇降レバー42を前に傾倒させると、昇降ユニット30(図1参照)が降下し、オペレータが昇降レバー42を後ろに傾倒させると、昇降ユニット30(図1参照)が上昇する。 The elevating lever 42 is held in an upright neutral position, and can be tilted in the front-rear direction from the neutral position. An elevating operation state detecting means 42S is provided in the vicinity of the elevating lever 42, and the machine base control device 40 has the elevating lever 42 in a neutral position based on a detection signal from the elevating operation state detecting means 42S. It is possible to detect in which direction it is tilted back and forth, and how much the operation amount (operation angle) is when it is tilted. When the operator tilts the elevating lever 42 forward, the elevating unit 30 (see FIG. 1) descends, and when the operator tilts the elevating lever 42 backward, the elevating unit 30 (see FIG. 1) rises.

アクセルレバー43は、直立した中立位置に保持されており、中立位置から前後方向へと傾倒可能とされている。アクセルレバー43の近傍には、アクセル操作状態検出手段43Sが設けられており、機台制御装置40は、アクセル操作状態検出手段43Sからの検出信号に基づいて、アクセルレバー43が、中立位置であるか、前後のどちらの方向に傾倒されているか、傾倒されている場合の操作量(操作角度)はどれくらいか、を検出可能である。オペレータがアクセルレバー43を前に傾倒させると、フォークリフト1が前進し、オペレータがアクセルレバー43を後ろに傾倒させると、フォークリフト1が後退する。 The accelerator lever 43 is held in an upright neutral position, and can be tilted in the front-rear direction from the neutral position. An accelerator operation state detecting means 43S is provided in the vicinity of the accelerator lever 43, and the machine base control device 40 has the accelerator lever 43 in a neutral position based on a detection signal from the accelerator operation state detecting means 43S. It is possible to detect in which direction it is tilted back and forth, and how much the operation amount (operation angle) is when it is tilted. When the operator tilts the accelerator lever 43 forward, the forklift 1 moves forward, and when the operator tilts the accelerator lever 43 backward, the forklift 1 moves backward.

モニタ47は、例えば液晶表示装置であり、機台制御装置40からの種々の情報(例えば、バッテリの容量情報)や、警告(例えば、充電の督促)が表示される。音声出力装置48は、例えばスピーカであり、機台制御装置40から種々の警告等を音声で出力する。ランプ49は、例えば複数のLEDランプであり、機台制御装置40から、種々の警告に対応付けられたランプが点灯されたり消灯されたりする。 The monitor 47 is, for example, a liquid crystal display device, and various information (for example, battery capacity information) and warnings (for example, charging reminder) from the machine stand control device 40 are displayed. The voice output device 48 is, for example, a speaker, and various warnings and the like are output by voice from the machine stand control device 40. The lamp 49 is, for example, a plurality of LED lamps, and the lamps associated with various warnings are turned on and off from the machine stand control device 40.

機台制御装置40は、制御装置に相当しており、図8に示すように、シフト位置検出手段31S、ローテート角度検出手段33S、操作状態検出手段41S、昇降操作状態検出手段42S、アクセル操作状態検出手段43S、特殊ボタン44、図示省略した昇降位置検出手段や車速検出手段からの検出信号等が入力される。また機台制御装置40は、図8に示すように、モニタ47(表示装置)、音声出力装置48、ランプ49、シフトモータ31M、ローテートモータ33M、昇降モータ30M、走行モータ16M等を動作させる制御信号を出力する。なお、機台制御装置40は、記憶装置を有している。 The machine base control device 40 corresponds to the control device, and as shown in FIG. 8, the shift position detecting means 31S, the rotate angle detecting means 33S, the operating state detecting means 41S, the elevating operation state detecting means 42S, and the accelerator operating state. Detection signals from the detection means 43S, the special button 44, the elevating position detecting means (not shown), the vehicle speed detecting means, and the like are input. Further, as shown in FIG. 8, the machine base control device 40 controls to operate a monitor 47 (display device), an audio output device 48, a lamp 49, a shift motor 31M, a rotate motor 33M, an elevating motor 30M, a traveling motor 16M, and the like. Output a signal. The machine base control device 40 has a storage device.

●[第1の実施の形態における機台制御装置40の処理手順(図9〜図17)]
次に図9及び図10に示すフローチャートを用いて、機台制御装置40によるシフトモータ31Mとローテートモータ33Mの制御の処理手順について説明する。なお図9に示すフローチャートは、ステップS515にて現在フォーク状態が禁止領域内に入っていると判定された場合における禁止領域内の処理を示し、図10に示すフローチャートは、ステップS515にて現在フォーク状態が禁止領域内に入っていないと判定された場合(許可領域内と判定した場合)における許可領域内の処理を示している。機台制御装置40は、例えば所定時間間隔(例えば数ms〜数10ms間隔)にて、図9に示す処理を起動し、起動した場合、ステップS510へと処理を進める。
● [Processing procedure of the machine base control device 40 in the first embodiment (FIGS. 9 to 17)]
Next, the processing procedure for controlling the shift motor 31M and the rotate motor 33M by the machine base control device 40 will be described with reference to the flowcharts shown in FIGS. 9 and 10. The flowchart shown in FIG. 9 shows the processing in the prohibited area when it is determined in step S515 that the fork state is currently in the prohibited area, and the flowchart shown in FIG. 10 shows the processing in the prohibited area in step S515. Indicates the processing in the permitted area when it is determined that the state is not in the prohibited area (when it is determined to be in the permitted area). The machine stand control device 40 activates the process shown in FIG. 9 at a predetermined time interval (for example, an interval of several ms to several tens of ms), and when activated, proceeds to step S510.

ステップS510にて、機台制御装置40は、ローテート角度検出手段からの検出信号に基づいて、現在のフォーク35のローテート角度である現在ローテート角度を検出して記憶し、シフト位置検出手段からの検出信号に基づいて、現在のアーム32(フォーク35)のシフト位置である現在シフト位置を検出して記憶する。また、機台制御装置40は、操作レバー41に対応する操作状態検出手段41Sからの検出信号に基づいて、操作レバー41の傾倒方向(前、後、左、右、傾倒なし(中立位置))と操作量(操作角度)を検出して操作手段操作状態として記憶し、特殊ボタン44が押されているか否か(ONとされているか否か)を検出して記憶する。 In step S510, the machine base control device 40 detects and stores the current rotation angle, which is the current rotation angle of the fork 35, based on the detection signal from the rotation angle detecting means, and detects it from the shift position detecting means. Based on the signal, the current shift position, which is the current shift position of the arm 32 (fork 35), is detected and stored. Further, the machine base control device 40 tilts the operating lever 41 in the tilting direction (front, rear, left, right, no tilt (neutral position)) based on the detection signal from the operating state detecting means 41S corresponding to the operating lever 41. And the operation amount (operation angle) are detected and stored as an operation means operation state, and whether or not the special button 44 is pressed (whether or not it is turned on) is detected and stored.

なお、図12に示すように、フォーク35は、右ホームポジションにて説明した左向き角度から、左ホームポジションにて説明した右向き角度まで、右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能である。そして、図12に示すように、フォーク35の向きを車体の前進方向とした場合のローテート角度を0[°]、フォーク35の向きを前記左向き角度とした場合のローテート角度を−90[°]、フォーク35の向きを前記右向き角度とした場合のローテート角度を+90[°]、と設定する。 As shown in FIG. 12, the fork 35 can perform a right-rotating operation from the left-pointing angle described in the right home position to the right-pointing angle described in the left home position, and the fork 35 can perform the right-pointing operation from the right-pointing angle. Left rotation operation is possible up to a leftward angle. Then, as shown in FIG. 12, the rotation angle when the direction of the fork 35 is the forward direction of the vehicle body is 0 [°], and the rotation angle when the direction of the fork 35 is the leftward angle is −90 [°]. , The rotation angle when the direction of the fork 35 is the rightward angle is set to +90 [°].

アーム32は、左シフト限界位置(シフトレール31のほぼ左端)から右シフト限界位置(シフトレール31のほぼ右端)の範囲で左右に移動可能である。図11に示すように、シフト関連量には、シフト位置を角度に換算した換算角度を設定する。左シフト限界位置から前記右シフト限界位置までの中央となるシフト位置を換算角度0[°]、右シフト限界位置となるシフト位置を換算角度+90[°]、左シフト限界位置となるシフト位置を換算角度−90[°]、と設定する。そして、左シフト限界位置から右シフト限界位置に至るまでの各シフト位置を、換算角度−90[°]から換算角度+90[°]の範囲内において対応する換算角度に設定する。なお、シフト関連量(換算角度)については、以下に詳細を説明する。 The arm 32 can move left and right within a range from the left shift limit position (the substantially left end of the shift rail 31) to the right shift limit position (the substantially right end of the shift rail 31). As shown in FIG. 11, a conversion angle obtained by converting the shift position into an angle is set for the shift-related amount. The central shift position from the left shift limit position to the right shift limit position is the conversion angle 0 [°], the shift position that is the right shift limit position is the conversion angle +90 [°], and the shift position that is the left shift limit position is The conversion angle is set to -90 [°]. Then, 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 [°]. The shift-related amount (conversion angle) will be described in detail below.

[シフト位置をシフト関連量に変換する手順(図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 base control device 40 stores the shift position / converted angle characteristics shown in FIG. As for the shift position / conversion angle characteristic, the horizontal axis is the shift position and the vertical axis is the conversion angle, and the shift position between the left end and the right end (from the left shift limit position to the right shift limit position) of the shift rail is converted. This is a characteristic for converting from an angle of −90 [°] to a conversion angle of +90 [°]. As shown in FIG. 11, for example, in the case of a shift rail having a length L1 in the left-right direction, the center position in the left-right direction is set to a conversion angle of 0 [°], and the left end position (left shift limit position) is set to a conversion angle of −90 [ Set to [°] and set the rightmost position (right shift limit position) to the conversion angle +90 [°]. Then, each position from the center position to the left end is set to a conversion angle of 0 [°] to -90 [°] according to the position, and each position from the center position to the right end is set to 0 [°] according to the position. Set to a conversion angle of ~ + 90 [°]. Similarly, for example, in the case of a shift rail having a length L2 in the left-right direction, the center position in the left-right direction is set to a conversion angle of 0 [°], and the left end position (left shift limit position) is set to a conversion angle of −90 [°]. Then, the right end position (right shift limit position) is set to the conversion angle +90 [°]. Then, each position from the center position to the left end is set to a conversion angle of 0 [°] to -90 [°] according to the position, and each position from the center position to the right end is set to 0 [°] according to the position. Set to a conversion angle of ~ + 90 [°].

シフトレールの左端から右端までの長さ(左右方向の長さ)は、作業する通路の通路幅に応じて、種々の長さとされる場合がある。この長さが変更された場合、アーム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 arm 32 left and right to the target shift position. However, if converted to the above conversion angle, the left shift limit position is the conversion angle -90 [°] and the right shift limit position is the conversion angle +90 [°] regardless of the length in the left-right direction. °], which is convenient because it is not necessary to adjust the control gain according to the length of the shift rail in the left-right direction. Hereinafter, the value of the conversion angle obtained by converting the shift position based on the shift position / conversion angle characteristic shown in FIG. 11 is described as “shift-related amount” (that is, shift-related amount = conversion angle). The machine stand control device 40 stores the current shift-related amount obtained from the current shift position of the arm 32 (fork 35). Then, the machine base control device 40 proceeds to step S515. The current rotation angle, the current shift-related amount, the tilting direction of the operating lever, the operating state of the operating means, and the ON / OFF state of the special button stored above are used in the following processing.

なお、アーム32のシフト位置については、シフトレール31の左右方向の中心位置から右方向「+」への距離、シフトレール31の左右方向の中心位置から左方向「−」への距離、で表してもよいが、本実施の形態では、シフト位置を、以上に説明したシフト関連量(換算角度)に変換して制御に使用している。 The shift position of the arm 32 is represented by the distance from the center position in the left-right direction of the shift rail 31 to the right direction "+" and the distance from the center position in the left-right direction of the shift rail 31 to the left direction "-". However, in the present embodiment, the shift position is converted into the shift-related amount (converted angle) described above and used for control.

ステップS515にて機台制御装置40は、図16に示すシフト・ローテート同期基準特性(同期基準特性に相当)と、現在フォーク状態(現在ローテート角度、現在シフト関連量のフォークの状態)と、に基づいて、現在フォーク状態が、シフト・ローテート同期基準特性における禁止領域内(左禁止領域AL内または右禁止領域AR内)に入っているか否かを判定し、現在フォーク状態が禁止領域内に入っている場合(Yes)はステップS530に進み、現在フォーク状態が禁止領域内に入っていない場合(No)はステップS520に進む。ステップS515の処理は、現在フォーク状態が、シフト・ローテート同期基準特性における禁止領域であるか否かを判定する禁止領域内確認ステップに相当している。 In step S515, the machine base control device 40 has a shift / rotate synchronization reference characteristic (corresponding to the synchronization reference characteristic) shown in FIG. 16 and a current fork state (current rotation angle, current shift-related amount of fork state). Based on this, it is determined whether or not the current fork state is in the prohibited area (in the left prohibited area AL or in the right prohibited area AR) in the shift / rotate synchronization reference characteristic, and the current fork state is in the prohibited area. If yes, the process proceeds to step S530, and if the fork state is not currently in the prohibited area (No), the process proceeds to step S520. The process of step S515 corresponds to the confirmation step in the prohibited area for determining whether or not the current fork state is the prohibited area in the shift / rotate synchronization reference characteristic.

なお、機台制御装置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 base control device 40. In the shift / rotate synchronization reference characteristics shown in FIG. 16, the horizontal axis represents the shift-related amount (converted angle), and the vertical axis represents the rotate angle. In the shift / rotate synchronization reference characteristic shown in FIG. 16, the coordinates of the right home position HR (converted angle, rotate angle) are HR (+90, -90), and the coordinates of the left home position HL (converted angle, rotate angle). Is HL (-90, +90). The coordinates (converted angle, rotate angle) of the central home position HC are HC (0, 0). The shift / rotate synchronization reference characteristic shown in FIG. 16 is a straight line (synchronization reference straight line S) passing through HL (−90, +90), HC (0, 0), and HR (+90, −90). This synchronization reference straight line S is a synchronous operation in which a left rotation operation (left turn) is performed while performing a right shift operation (shift movement to the right) from the left home position to the right home position, and a left home from the right home position. It is a locus showing a synchronous operation of performing a right rotate operation (right turn) while performing a left shift operation (shift movement to the left) to a position. Further, in the shift / rotate synchronization reference characteristic shown in FIG. 16, a region where the fork 35 protrudes to the left and right from the width of the vehicle body of the forklift and a shift-related amount is set as a prohibited region. In the example shown in FIG. 16, the prohibited area has a left prohibited area AL and a right prohibited area AR shown by hatching.

ステップS520に進んだ場合、機台制御装置40は、禁止領域内に入っていないことをオペレータに伝えるために、モニタ47に禁止領域内であることの警告をしていた場合は当該表示を中止し、音声出力装置48から禁止領域内であることの警告を出力していた場合は当該出力を中止し、禁止領域内であることの警告を示すランプ49を点灯させていた場合は当該ランプを消灯して、ステップS525に進む。 When the process proceeds to step S520, the machine console control device 40 cancels the display if it has warned the monitor 47 that it is in the prohibited area in order to inform the operator that it is not in the prohibited area. However, if the voice output device 48 has output a warning that it is in the prohibited area, the output is stopped, and if the lamp 49 indicating that it is in the prohibited area is turned on, the lamp is turned on. The light is turned off and the process proceeds to step S525.

ステップS525に進んだ場合、機台制御装置40は、図10に示すSUB100の処理を実行する。以下、まず図10に示すSUB100の処理について説明する。SUB100の処理は、現在フォーク状態が禁止領域内に入っていない場合における許可領域内の処理である。 When the process proceeds to step S525, the machine base control device 40 executes the process of the SUB 100 shown in FIG. Hereinafter, the processing of the SUB 100 shown in FIG. 10 will be described first. The process of the SUB 100 is a process in the permitted area when the fork state is not currently in the prohibited area.

●[現在フォーク状態が禁止領域内に入っていない場合の処理(図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 stand control device 40 proceeds to step S115.

ステップS115にて機台制御装置40は、特殊ボタンがON状態(押されている状態)であるか否かを判定し、ON状態である場合(Yes)はステップS220に進み、ON状態でない場合(No)はステップS120に進む。 In step S115, the machine base control device 40 determines whether or not the special button is in the ON state (pressed state), and if it is in the ON state (Yes), the process proceeds to step S220, and if it is not in the ON state. (No) proceeds to step S120.

ステップS220に進んだ場合、機台制御装置40は、特殊ボタンがON状態とされていることをオペレータに伝えるために、モニタ47に警告表示を行ったり、音声出力装置48から音声で警告したり、警告を示すランプ49を点灯させたりして、ステップS225に進む。 When the process proceeds to step S220, the machine base control device 40 displays a warning on the monitor 47 or gives a voice warning from the voice output device 48 in order to inform the operator that the special button is in the ON state. , The warning lamp 49 is turned on, and the process proceeds to step S225.

ステップS225にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS335に進み、前または後ろでない場合(No)はステップS230に進む。 In step S225, the machine stand control device 40 determines whether or not the tilting direction of the operating lever is forward or backward based on the operating state of the operating means, and if it is forward or backward (Yes), the process proceeds to step S335. If it is not forward or backward (No), the process proceeds to step S230.

[ローテートのみの実行]
ステップ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 base control device 40 executes only the rotate feedback control (rotate when the special button is ON) without performing the shift feedback control in the following steps S335 and S340. In step S335, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount / addition rotation shown in FIG. The added rotate amount is obtained based on the quantity characteristic. For example, when the tilting direction of the operating lever is forward and the operating angle is θ1, the addition rotation amount = + R1r is obtained as shown in FIG. The front-rear operation amount and the addition rotation amount characteristic are stored in the storage device of the machine base control device 40. As for the front-rear operation amount / addition rotation amount characteristic, the horizontal axis is the front-rear operation amount (operation angle), and the vertical axis is the addition rotation amount. The front-rear operation amount / addition rotation amount characteristic is not limited to the characteristic shown in FIG. Then, the machine stand control device 40 for which the added rotation amount has been obtained adds the obtained added rotation amount to the current rotation angle to obtain the target rotation angle, stores the obtained target rotation angle, and proceeds to step S340. When determining the target rotation angle, the machine base control device 40 sets the upper limit of the target rotation angle to +90 [°] and the lower limit to −90 [°].

ステップS340にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、処理を終了する。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。 In step S340, the machine stand control device 40 executes the rotate feedback control based on the deviation between the target rotate angle and the current rotate angle, and drives the rotate motor so that the rotate angle approaches the target rotate angle. , End the process. Since the target rotation angle is the value obtained by adding the addition rotation amount according to the operation amount of the operation lever to the rotation angle at present, when the operation amount is large, the deviation becomes large and the rotation speed becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the rotate operation becomes small. Therefore, the operator can adjust the speed of the rotate operation by adjusting the operation amount (operation angle). In addition, by setting the upper limit of the target rotation angle to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90 [°]. The rotation operation can be stopped when the temperature reaches [°] or −90 [°].

また、ステップS230に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS245に進み、左または右でない場合(No)は、操作レバーが中立位置であるので、処理を終了する。 Further, when the process proceeds to step S230, the machine base control device 40 determines whether or not the tilting direction of the operating lever is left or right based on the operating state of the operating means, and if it is left or right (Yes). Goes to step S245, and if it is not left or right (No), the operation lever is in the neutral position, and the process ends.

[シフトのみの実行]
ステップ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 base control device 40 executes only shift feedback control (shift when the special button is ON) in the following steps S245 and S265. In step S245, the machine base control device 40 determines the tilting direction (in this case, right or left) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the left-right operation amount / addition shift shown in FIG. The addition shift related quantity is obtained based on the related quantity characteristic. For example, when the tilting direction of the operating lever = right and the operating angle = θ3, as shown in FIG. 13, the addition shift related amount = + R3s is obtained. The left-right operation amount and the addition shift-related amount characteristic are stored in the storage device of the machine base control device 40. As for the left-right operation amount / addition shift-related amount characteristic, the horizontal axis is the left-right operation amount (operation angle), and the vertical axis is the addition shift-related amount. The left-right operation amount / addition shift-related amount characteristic is not limited to the characteristic shown in FIG. Then, the machine control device 40 for which the addition shift-related amount has been obtained obtains the target shift-related amount (target conversion angle) by adding the obtained addition shift-related amount to the current shift-related amount (conversion angle), and obtains the target. The shift-related amount is stored, and the process proceeds to step S265. When obtaining the target shift-related amount, the machine base control device 40 sets the upper limit of the target shift-related amount to +90 [°] and the lower limit to −90 [°].

ステップS265にて機台制御装置40は、目標シフト関連量(目標換算角度)と、現在シフト関連量(換算角度)と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。 In step S265, the machine stand control device 40 executes shift feedback control based on the deviation between the target shift-related amount (target conversion angle) and the current shift-related amount (conversion angle), and the shift-related amount is the target. The shift motor is driven so as to approach the shift-related amount, and the process is terminated. Since the target shift-related amount is the value obtained by adding the addition shift-related amount according to the operation amount of the operation lever to the shift-related amount at present, when the operation amount is large, the deviation becomes large and the speed of the shift operation becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the shift operation becomes small. Therefore, the operator can adjust the speed of the shift operation by adjusting the operation amount (operation angle). In addition, by setting the upper limit of the target shift-related amount to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90. The shift operation can be stopped when it reaches [°] or −90 [°].

また、ステップ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 stand control device 40, the warning display of the special button ON on the monitor 47 is stopped, or the special button ON in the voice output device 48 is turned on. The warning output is stopped, the lamp 49 indicating that the special button is ON is turned off, and the process proceeds to step S125.

ステップS125にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS245に進み、左または右でない場合(No)はステップS130に進む。なお、ステップS245に進んだ場合のステップS245、S265の処理については、すでに説明しているので説明を省略する。 In step S125, the machine base control device 40 determines whether or not the tilting direction of the operating lever is left or right based on the operating state of the operating means, and if it is left or right (Yes), the process proceeds to step S245. If it is not left or right (No), the process proceeds to step S130. Since the processing of steps S245 and S265 when the process proceeds to step S245 has already been described, the description thereof will be omitted.

ステップS130に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS135に進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。 When the process proceeds to step S130, the machine base control device 40 determines whether or not the tilting direction of the operating lever is forward or backward based on the operating state of the operating means, and if it is forward or backward (Yes), the step. If the process proceeds to S135 and is not forward or backward (No), the operation lever is in the neutral position, and the process ends.

[ローテートとシフトの自動同期制御の実行]
ステップ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 fork 35 to the right home position or a left home position instruction for setting the state of the fork 35 to the left home position is input (by operating the operation lever). This is the processing when In the following, the operating lever is tilted "forward" (operation) from the state where the current fork state is P1 (current shift-related amount, current rotation angle) = P1 (+30, -60) in FIG. A case where the angle = θ1) is set and the left home position is instructed will be described as a specific example.

ステップS135に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。そして加算ローテート量を求めた機台制御装置40は、現在ローテート角度に、求めた加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS140に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。 When the process proceeds to step S135, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount shown in FIG. -Additional rotation amount Obtain the additional rotation amount based on the characteristics. Then, the machine stand control device 40 for which the added rotation amount has been obtained adds the obtained added rotation amount to the current rotation angle to obtain the target rotation angle, stores the obtained target rotation angle, and proceeds to step S140. When determining the target rotation angle, the machine base control device 40 sets the upper limit of the target rotation angle to +90 [°] and the lower limit to −90 [°].

具体的には、機台制御装置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 base control device 40, the tilting direction of the operating lever based on the operating state of the operating means = "front", the operating amount = θ1, and the additional rotation amount from the front-rear operation amount and the addition rotation amount in FIG. = + R1r [°] is calculated. Then, the machine base control device 40 obtains the target rotation angle from the current rotation angle + the added rotation amount (+ R1r), and stores the obtained target rotation angle. As shown in FIG. 16, the target rotation angle T1r obtained with respect to the current rotation angle P1r (= -60) in the current state P1 (+30, -60) is −60 + R1r. Here, assuming that + R1r = 10 [°], the target rotation angle is T1r = -60 + 10 = -50 [°]. Note that step S135 corresponds to the target rotation angle calculation step.

ステップS140にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、ステップS145に進む。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。 In step S140, the pedestal control device 40 executes the rotate feedback control based on the deviation between the target rotation angle and the current rotation angle, and drives the rotation motor so that the rotation angle approaches the target rotation angle. , Step S145. Since the target rotation angle is the value obtained by adding the addition rotation amount according to the operation amount of the operation lever to the rotation angle at present, when the operation amount is large, the deviation becomes large and the rotation speed becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the rotate operation becomes small. Therefore, the operator can adjust the speed of the rotate operation by adjusting the operation amount (operation angle) even during the automatic synchronization control of the shift operation and the rotate operation. In addition, by setting the upper limit of the target rotation angle to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90 [°]. The rotation operation can be stopped when the temperature reaches [°] or −90 [°].

具体的には、機台制御装置40は、目標ローテート角度T1r(=−50[°])と、現在ローテート角度P1r(=−60[°])と、の偏差に基づいて、フィードバック制御量を求め、求めた制御量に基づいて、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動する。また、ステップS140は、ローテートフィードバック制御ステップに相当している。 Specifically, the machine base control device 40 determines the feedback control amount based on the deviation between the target rotation angle T1r (= -50 [°]) and the current rotation angle P1r (= -60 [°]). Based on the obtained control amount, the rotation motor is driven so that the rotation angle approaches the target rotation angle. Further, step S140 corresponds to a rotate feedback control step.

ステップS145にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図15に示す前後操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。なお、前後操作量・加算シフト関連量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算シフト関連量特性は、横軸が前後の操作量(操作角度)、縦軸が加算シフト関連量とされている。なお、前後操作量・加算シフト関連量特性は、図15に示す特性に限定されるものではない。 In step S145, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount / addition shift shown in FIG. The addition shift related quantity is obtained based on the related quantity characteristic. The front-rear operation amount and the addition shift-related amount characteristic are stored in the storage device of the machine base control device 40. As for the front-back operation amount / addition shift-related amount characteristic, the horizontal axis is the front-back operation amount (operation angle), and the vertical axis is the addition shift-related amount. The front-back operation amount / addition shift-related amount characteristic is not limited to the characteristic shown in FIG.

具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「前」、操作量=θ1と、図15の前後操作量・加算シフト関連量特性より、加算シフト関連量=−R1s[°]を求める。 Specifically, the machine base control device 40 adds from the tilt direction of the operating lever = "front" and the operating amount = θ1 based on the operating state of the operating means, and the front-rear operation amount / addition shift-related amount characteristic of FIG. The shift-related quantity = −R1s [°] is obtained.

加算シフト関連量を求めた機台制御装置40は、現在ローテート角度と、図16に示すシフト・ローテート同期基準特性とに基づいて、現在ローテート角度に対応するシフト関連量(換算角度)である同期シフト関連量を求め、求めた同期シフト関連量に加算シフト関連量を加算して目標シフト関連量(目標換算角度)を求め、求めた目標シフト関連量を記憶し、ステップS150に進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。 The machine stand control device 40 for which the additional shift-related amount has been obtained is a synchronization that is a shift-related amount (converted angle) corresponding to the current rotation angle based on the current rotation angle and the shift-rotate synchronization reference characteristic shown in FIG. The shift-related amount is obtained, the addition shift-related amount is added to the obtained synchronous shift-related amount to obtain the target shift-related amount (target conversion angle), the obtained target shift-related amount is stored, and the process proceeds to step S150. When obtaining the target shift-related amount, the machine base control device 40 sets the upper limit of the target shift-related amount to +90 [°] and the lower limit to −90 [°].

具体的には、機台制御装置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 base control device 40 has P1r (= -60 [°], which is the current rotation angle at P1 (+30, -60), which is the current state of the fork, on the synchronization reference line S in FIG. ]) Is obtained as P1s (= +60 [°]) which is a synchronous shift-related amount which is a shift-related amount (conversion angle) corresponding to). Then, the machine base control device 40 obtains the target shift-related amount from the synchronous shift-related amount P1s (= +60 [°]) + the addition shift-related amount (= −R1s), and stores the obtained target shift-related amount. When this is shown in FIG. 16, the synchronous shift-related amount P1s (= +60) corresponding to the current state P1 (+30, -60) + the additional shift-related amount (= −R1s) = the target shift-related amount. .. Here, assuming that −R1s = −10 [°], the target shift-related amount is T1s = + 60-10 = + 50 [°]. That is, the target rotation angle T1r (= -50) obtained in step S135 and T1 (+50, -50) represented by the target shift-related quantity T1s (= +50) obtained in step S145 are the current forks. It is a target state to go from P1 (+30, -60) of the state of. Note that step S145 corresponds to the target shift-related amount calculation step.

ステップS150にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前であるか否かを判定し、前である場合(Yes)はステップS155に進み、前でない場合(No)はステップS160に進む。 In step S150, the machine base control device 40 determines whether or not the tilting direction of the operating lever is forward based on the operating state of the operating means. If it is forward (Yes), the process proceeds to step S155, and if it is not forward. (No) proceeds to step S160.

ステップS155に進んだ場合、機台制御装置40は、ステップS145にて求めた目標シフト関連量が、現在シフト関連量よりも右(+の側)にあるか否かを判定し、右(+の側)にある場合(Yes)は処理を終了し、右(+の側)でない場合(No)はステップS165に進む。つまり、左ホームポジション指示が入力された際に求めた目標シフト関連量が、現在シフト関連量に対して、フォークを右シフト動作させると判定した場合、シフトフィードバック制御を中止(スキップ)する。 When the process proceeds to step S155, the machine base control device 40 determines whether or not the target shift-related amount obtained in step S145 is on the right (+ side) of the current shift-related amount, and determines whether or not the target shift-related amount is on the right (+ side). If it is on the side of) (Yes), the process ends, and if it is not on the right (+ side) (No), the process proceeds to step S165. That is, when the target shift-related amount obtained when the left home position instruction is input determines that the fork is shifted to the right with respect to the current shift-related amount, the shift feedback control is stopped (skipped).

具体的には、図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 base control device 40 determines whether or not the target shift-related amount obtained in step S145 is on the left (-side) of the current shift-related amount, and is left (-). If it is on the left (-side) (Yes), the process ends, and if it is not on the left (-side) (No), the process proceeds to step S165. That is, when the target shift-related amount obtained when the right home position instruction is input determines that the fork is to shift left with respect to the current shift-related amount, the shift feedback control is stopped (skipped).

ステップS165に進んだ場合、機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在ローテート角度に対応するシフト関連量である同期シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。また、同期基準直線Sから離れているほど偏差が大きくなってシフト動作の速度が大きくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、右ホームポジションや左ホームポジションでなくても、上記のとおり、現在のフォークのシフト位置やローテート角度にかかわらず、右ホームポジションや左ホームポジションへの移動を実行することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。なお、ステップS165は、シフトフィードバック制御ステップに相当している。 When the process proceeds to step S165, the machine base control device 40 executes shift feedback control based on the deviation between the target shift-related amount and the current shift-related amount so that the shift-related amount approaches the target shift-related amount. Drive the shift motor to finish the process. Since the target shift-related amount is the sum of the synchronous shift-related amount, which is the shift-related amount corresponding to the rotation angle, and the addition shift-related amount according to the operation amount of the operating lever, the deviation is large when the operation amount is large. As it increases, the speed of shift operation increases. Further, when the operation amount is small, the deviation becomes small, so that the speed of the shift operation becomes small. Further, the farther away from the synchronization reference straight line S, the larger the deviation and the faster the shift operation speed. Therefore, the operator can adjust the speed of the shift operation by adjusting the operation amount (operation angle) even during the automatic synchronization control of the shift operation and the rotate operation. Further, as described above, the movement to the right home position or the left home position can be executed regardless of the current shift position or rotation angle of the fork, even if the fork is not in the right home position or the left home position. In addition, by setting the upper limit of the target shift-related amount to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90. The shift operation can be stopped when it reaches [°] or −90 [°]. Note that step S165 corresponds to the shift feedback control step.

なお、図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 stand control device 40 determines whether or not the current rotation angle is +90 [°] or −90 [°], and the current rotation angle is +90 [°] or −90 [°]. If (Yes), the process proceeds to step S535A, and if the rotation angle is not currently +90 [°] or −90 [°] (No), the process proceeds to step S535B.

ステップS535Aに進んだ場合、機台制御装置40は、現在フォーク状態が禁止領域内に入っているが、右ホームポジションからの左右のシフト動作中、または左ホームポジションからの左右のシフト動作中であって、通常の荷役作業中である、と判定して禁止領域内であることの警告を解除する。例えば、機台制御装置40は、モニタ47に禁止領域内であることの警告をしていた場合は当該表示を中止し、音声出力装置48から禁止領域内であることの警告を出力していた場合は当該出力を中止し、禁止領域内であることの警告を示すランプ49を点灯させていた場合は当該ランプを消灯して、ステップS540に進む。 When the process proceeds to step S535A, the pedestal controller 40 is currently in the fork state in the prohibited area, but is in the left / right shift operation from the right home position or in the left / right shift operation from the left home position. Therefore, it is determined that normal cargo handling work is in progress, and the warning that it is within the prohibited area is canceled. For example, when the machine stand control device 40 warns the monitor 47 that it is in the prohibited area, the display is stopped and the voice output device 48 outputs a warning that it is in the prohibited area. In that case, the output is stopped, and if the lamp 49 indicating the warning that the area is within the prohibited area is turned on, the lamp is turned off and the process proceeds to step S540.

ステップS535Bに進んだ場合、機台制御装置40は、荷役作業中でない状態で、現在フォーク状態が禁止領域内に入っていると判定し、禁止領域内であることの警告を発する。例えば、機台制御装置40は、モニタ47に禁止領域内であることの警告表示し、音声出力装置48から禁止領域内であることの警告を出力し、禁止領域内であることの警告を示すランプ49を点灯させ、ステップS540に進む。 When the process proceeds to step S535B, the machine base control device 40 determines that the fork state is currently in the prohibited area while the cargo handling work is not in progress, and issues a warning that the fork state is in the prohibited area. For example, the machine base control device 40 displays a warning that the monitor 47 is in the prohibited area, outputs a warning that the voice output device 48 is in the prohibited area, and indicates that the warning is in the prohibited area. The lamp 49 is turned on, and the process proceeds to step S540.

ステップS540にて機台制御装置40は、特殊ボタンがON状態(押されている状態)であるか否かを判定し、ON状態である場合(Yes)はステップS645に進み、ON状態でない場合(No)はステップS545に進む。 In step S540, the machine base control device 40 determines whether or not the special button is in the ON state (pressed state), and if it is in the ON state (Yes), the process proceeds to step S645, and if it is not in the ON state. (No) proceeds to step S545.

ステップS645に進んだ場合、機台制御装置40は、特殊ボタンがON状態とされていることをオペレータに伝えるために、特殊ボタンがONであることを、モニタ47に表示したり、音声出力装置48から音声を出力したり、警告を示すランプ49を点灯させたりして、ステップS650に進む。 When the process proceeds to step S645, the machine stand control device 40 displays on the monitor 47 that the special button is ON or an audio output device in order to inform the operator that the special button is in the ON state. The voice is output from 48, the lamp 49 indicating a warning is turned on, and the process proceeds to step S650.

ステップS650にて機台制御装置40は、操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS765に進み、前または後ろでない場合(No)はステップS655に進む。 In step S650, the machine stand control device 40 determines whether or not the tilting direction of the operating lever is forward or backward, and if it is forward or backward (Yes), the process proceeds to step S765, and if it is not forward or backward (Yes). No) proceeds to step S655.

ステップ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 base control device 40 executes only the rotate feedback control (rotate when the special button is ON) without performing the shift feedback control in the following steps S765 and S780. In step S765, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount / addition rotation shown in FIG. The added rotate amount is obtained based on the quantity characteristic. For example, when the tilting direction of the operating lever is forward and the operating angle is θ1, the addition rotation amount = + R1r is obtained as shown in FIG. The front-rear operation amount and the addition rotation amount characteristic are stored in the storage device of the machine base control device 40. As for the front-rear operation amount / addition rotation amount characteristic, the horizontal axis is the front-rear operation amount (operation angle), and the vertical axis is the addition rotation amount. The front-rear operation amount / addition rotation amount characteristic is not limited to the characteristic shown in FIG. Then, the machine stand control device 40 for which the added rotation amount has been obtained adds the obtained added rotation amount to the current rotation angle to obtain the target rotation angle, stores the obtained target rotation angle, and proceeds to step S780. When determining the target rotation angle, the machine base control device 40 sets the upper limit of the target rotation angle to +90 [°] and the lower limit to −90 [°].

ステップS780にて機台制御装置40は、目標ローテート角度と、現在ローテート角度と、の偏差に基づいてローテートフィードバック制御を実行して、ローテート角度が目標ローテート角度に近づくようにローテートモータを駆動して、処理を終了する。現在ローテート角度に、操作レバーの操作量に応じた加算ローテート量を加算した値を目標ローテート角度としているので、操作量が大きな場合は偏差が大きくなってローテート動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでローテート動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでローテート動作の速度を調整することができる。また、目標ローテート角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでローテート動作を停止させることができる。 In step S780, the machine stand control device 40 executes the rotate feedback control based on the deviation between the target rotation angle and the current rotation angle, and drives the rotation motor so that the rotation angle approaches the target rotation angle. , End the process. Since the target rotation angle is the value obtained by adding the addition rotation amount according to the operation amount of the operation lever to the rotation angle at present, when the operation amount is large, the deviation becomes large and the rotation speed becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the rotate operation becomes small. Therefore, the operator can adjust the speed of the rotate operation by adjusting the operation amount (operation angle). In addition, by setting the upper limit of the target rotation angle to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90 [°]. The rotation operation can be stopped when the temperature reaches [°] or −90 [°].

例えば、図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 base control device 40 turns the fork to the right in the processes of steps S765 and S780. Then, in FIG. 17, when the operator turns off the special button and sets the operation lever to "neutral" when the fork state is currently Q3 (-30, -60), the fork state is Q3 (-). It is maintained in the state of 30, -60).

また、ステップS655に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS665に進み、左または右でない場合(No)は、操作レバーが中立位置であるので、処理を終了する。 Further, when the process proceeds to step S655, the machine base control device 40 determines whether or not the tilting direction of the operating lever is left or right based on the operating state of the operating means, and if it is left or right (Yes). Goes to step S665, and if it is not left or right (No), the operation lever is in the neutral position, and the process ends.

ステップ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 base control device 40 executes only shift feedback control (shift when the special button is ON) in the following steps S665 and S680. In step S665, the machine base control device 40 determines the tilting direction (in this case, right or left) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the left / right operation amount / addition shift shown in FIG. The addition shift related quantity is obtained based on the related quantity characteristic. For example, when the tilting direction of the operating lever = right and the operating angle = θ3, as shown in FIG. 13, the addition shift related amount = + R3s is obtained. The left-right operation amount and the addition shift-related amount characteristic are stored in the storage device of the machine base control device 40. As for the left-right operation amount / addition shift-related amount characteristic, the horizontal axis is the left-right operation amount (operation angle), and the vertical axis is the addition shift-related amount. The left-right operation amount / addition shift-related amount characteristic is not limited to the characteristic shown in FIG. Then, the machine control device 40 for which the addition shift-related amount has been obtained obtains the target shift-related amount (target conversion angle) by adding the obtained addition shift-related amount to the current shift-related amount (conversion angle), and obtains the target. The shift-related amount is stored, and the process proceeds to step S680. When obtaining the target shift-related amount, the machine base control device 40 sets the upper limit of the target shift-related amount to +90 [°] and the lower limit to −90 [°].

ステップS680にて機台制御装置40は、目標シフト関連量(目標換算角度)と、現在シフト関連量(換算角度)と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。 In step S680, the machine stand control device 40 executes shift feedback control based on the deviation between the target shift-related amount (target conversion angle) and the current shift-related amount (conversion angle), and the shift-related amount is the target. The shift motor is driven so as to approach the shift-related amount, and the process is terminated. Since the target shift-related amount is the value obtained by adding the addition shift-related amount according to the operation amount of the operation lever to the shift-related amount at present, when the operation amount is large, the deviation becomes large and the speed of the shift operation becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the shift operation becomes small. Therefore, the operator can adjust the speed of the shift operation by adjusting the operation amount (operation angle). In addition, by setting the upper limit of the target shift-related amount to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90. The shift operation can be stopped when it reaches [°] or −90 [°].

例えば、図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 base control device 40 moves the fork to the right in the processes of steps S665 and S680. Then, in FIG. 17, when the operator turns off the special button and sets the operation lever to "neutral" when the fork state is currently Q4 (+10, -60), the fork state is Q4 (+10, -60). It is maintained in the state of -60).

また、ステップ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 stand control device 40, the warning display of the special button ON on the monitor 47 is stopped, or the special button ON in the voice output device 48 is turned on. The warning output is stopped, the lamp 49 indicating that the special button is ON is turned off, and the process proceeds to step S550.

ステップS550にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が左または右であるか否かを判定し、左または右である場合(Yes)はステップS560に進み、左または右でない場合(No)はステップS555に進む。 In step S550, the machine stand control device 40 determines whether or not the tilting direction of the operating lever is left or right based on the operating state of the operating means, and if it is left or right (Yes), the process proceeds to step S560. If it is not left or right (No), the process proceeds to step S555.

ステップS560に進んだ場合、機台制御装置40は、現在ローテート角度が+90[°]または−90[°]であるか否かを判定し、現在ローテート角度が+90[°]または−90[°]である場合(Yes)はステップS665に進み、現在ローテート角度が+90[°]または−90[°]でない場合(No)はステップS565に進む。 If the process proceeds to step S560, the pedestal controller 40 determines whether or not the current rotation angle is +90 [°] or -90 [°], and the current rotation angle is +90 [°] or -90 [°]. ], The process proceeds to step S665, and if the rotation angle is not currently +90 [°] or −90 [°] (No), the process proceeds to step S565.

ステップ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 stand control device 40 moves the fork to the right in the processes of steps S665 and S680 via step S560. Then, in FIG. 17, when the operator sets the operation lever to "neutral" when the fork state is currently Q2 (-30, -90), the fork state is Q2 (-30, -90). Maintained in a state. Further, at this time, the rotation angle is −90 [°], which is a normal cargo handling operation, so that the warning of the prohibited area is canceled in step S535A.

ステップS555に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS565に進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。 When the process proceeds to step S555, the machine stand control device 40 determines whether or not the tilting direction of the operating lever is forward or backward based on the operating state of the operating means, and if it is forward or backward (Yes), the step. If the process proceeds to S565 and is not forward or backward (No), the operation lever is in the neutral position, and the process ends.

ステップ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 base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount shown in FIG. -Additional shift-related quantity Obtain the additional shift-related quantity based on the characteristics. Then, the machine control device 40 for obtaining the addition shift-related amount adds the obtained addition shift-related amount to the current shift-related amount to obtain the target shift-related amount, stores the obtained target shift-related amount, and steps S570. Proceed to. When obtaining the target shift-related amount, the machine base control device 40 sets the upper limit of the target shift-related amount to +90 [°] and the lower limit to −90 [°].

具体的には、機台制御装置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 base control device 40 adds from the front-back operation amount / addition shift-related amount in FIG. Find the shift-related amount = + R2s [°]. Then, the machine base control device 40 obtains the target shift-related amount from the current shift-related amount + the addition shift-related amount (+ R2s), and stores the obtained target shift-related amount. This is shown in FIG. 17, for example, when the current state is Q1 (-90, -90) and the addition shift-related amount = + R2s = + 10 [°], the current shift-related of Q1 (-90, -90). The target shift-related quantity with respect to the quantity (−90) is −90 + 10 = −80 [°].

ステップS570にて機台制御装置40は、現在フォーク状態が図17中における左禁止領域内に入っており、かつ、現在シフト関連量に対して目標シフト関連量が右側(+側)、であるか否かを判定し、満足している場合(Yes)はステップS580に進み、満足していない場合(No)はステップS575に進む。 In step S570, the pedestal control device 40 is currently in the fork state in the left prohibited area in FIG. 17, and the target shift-related amount is on the right side (+ side) with respect to the current shift-related amount. If it is satisfied (Yes), the process proceeds to step S580, and if it is not satisfied (No), the process proceeds to step S575.

ステップS575に進んだ場合、機台制御装置40は、現在フォーク状態が図17中における右禁止領域内に入っており、かつ、現在シフト関連量に対して目標シフト関連量が左側(−側)、であるか否かを判定し、満足している場合(Yes)はステップS580に進み、満足していない場合(No)は処理を終了する。 When the process proceeds to step S575, the pedestal control device 40 is currently in the fork state in the right prohibited area in FIG. 17, and the target shift-related amount is on the left side (-side) with respect to the current shift-related amount. If it is satisfied (Yes), the process proceeds to step S580, and if it is not satisfied (No), the process ends.

ステップS580に進んだ場合、機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、処理を終了する。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト角度の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。 When the process proceeds to step S580, the machine base control device 40 executes shift feedback control based on the deviation between the target shift-related amount and the current shift-related amount so that the shift-related amount approaches the target shift-related amount. Drive the shift motor to finish the process. Since the target shift-related amount is the value obtained by adding the addition shift-related amount according to the operation amount of the operation lever to the shift-related amount at present, when the operation amount is large, the deviation becomes large and the speed of the shift operation becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the shift operation becomes small. Therefore, the operator can adjust the speed of the shift operation by adjusting the operation amount (operation angle). In addition, by setting the upper limit of the target shift angle to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90 [°]. The shift operation can be stopped when the temperature reaches [°] or −90 [°].

上記のステップ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 stand control device 40 shifts the fork to the right in the process of steps S565 to S580. When the fork that has entered the left prohibited area reaches P1 (+30, -60) in FIG. 17 and escapes from the left prohibited area in the right shift operation, steps S515, S520, and S525. The process shifts to the SUB 100 shown in FIG. Then, as described above in steps S130 to S165 in the SUB 100 of FIG. 10, the shift operation and the rotate operation are automatically shifted to the synchronous operation. That is, for example, when the current fork state is Q4 (+10, -60) in the left prohibited area, the operator inputs the special button = OFF and the operation lever = "backward" to tilt (right home position instruction). You just have to continue. The machine stand control device 40 automatically performs only the right shift operation from Q4 (+10, -60) in FIG. 17 to P1 (+30, -60) until it escapes from the prohibited area. Then, after escaping from the prohibited area, the machine base control device 40 automatically shifts the control from P1 (+30, -60) to the synchronous control toward the right home position.

●[現在フォーク状態が禁止領域内に入っていない場合の処理における第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 shift motor 31M and the rotate motor 33M by the machine base control device 40 will be described with reference to the flowchart shown in FIG. The flowchart shown in FIG. 18 shows a flowchart that replaces FIG. 10 in the flowchart of the first embodiment. The flowchart of the second embodiment shown in FIG. 18 is different from the flowchart of FIG. 10 of the first embodiment in the processes of steps S135A, S140A, S145A, S155A, S160A, and S165A, and other processes. Is the same. Hereinafter, the differences in the flowchart will be mainly described.

ステップS130に進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前または後ろであるか否かを判定し、前または後ろである場合(Yes)はステップS135Aに進み、前または後ろでない場合(No)は、操作レバーが中立位置であるので、処理を終了する。 When the process proceeds to step S130, the machine base control device 40 determines whether or not the tilting direction of the operating lever is forward or backward based on the operating state of the operating means, and if it is forward or backward (Yes), the step. If the process proceeds to S135A and is not forward or backward (No), the operation lever is in the neutral position, and the process ends.

[ローテートとシフトの自動同期制御の実行]
ステップ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 fork 35 to the right home position or a left home position instruction for setting the state of the fork 35 to the left home position is input (by operating the operation lever). This is the processing when

なお、機台制御装置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 base control device 40. The synchronization reference line S, the left prohibited area AL, and the right prohibited area AR shown in FIG. 19 are the same as the synchronization reference line S, the left prohibited area AL, and the right prohibited area AR shown in FIG. In the following, in FIG. 19, the operation lever is moved "backward" from the state where the position in the left-right direction and the rotation angle are P2 (current shift-related amount, current rotation angle) = P2 (+30, -60). A case where the right home position is instructed by tilting (operating angle = θ2) will be described as a specific example.

ステップS135Aに進んだ場合、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図15に示す前後操作量・加算シフト関連量特性に基づいて、加算シフト関連量を求める。そして加算シフト関連量を求めた機台制御装置40は、現在シフト関連量に、求めた加算シフト関連量を加算して目標シフト関連量を求め、求めた目標シフト関連量を記憶し、ステップS140Aに進む。なお、機台制御装置40は、目標シフト関連量を求める際、目標シフト関連量の上限を+90[°]、下限を−90[°]にする。 When the process proceeds to step S135A, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount shown in FIG. -Additional shift-related quantity Obtain the additional shift-related quantity based on the characteristics. Then, the machine control device 40 for obtaining the addition shift-related amount adds the obtained addition shift-related amount to the current shift-related amount to obtain the target shift-related amount, stores the obtained target shift-related amount, and steps S140A. Proceed to. When obtaining the target shift-related amount, the machine base control device 40 sets the upper limit of the target shift-related amount to +90 [°] and the lower limit to −90 [°].

具体的には、機台制御装置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 base control device 40, the tilting direction of the operating lever based on the operating state of the operating means = "rear", the operating amount = θ2, and the addition shift is performed from the front-back operation amount / addition shift-related amount in FIG. Find the related quantity = + R2s [°]. Then, the machine base control device 40 obtains the target shift-related amount from the current shift-related amount + the addition shift-related amount (+ R2s), and stores the obtained target shift-related amount. As shown in FIG. 19, the target shift-related amount T2s obtained with respect to the current shift-related amount P2s (= +30) in the current state P2 (+30, -60) is +30 + R2s. Here, assuming that + R2s = 10 [°], the target shift-related amount is T2s = + 30 + 10 = + 40 [°]. Note that step S135A corresponds to the target shift-related amount calculation step.

ステップS140Aにて機台制御装置40は、目標シフト関連量と、現在シフト関連量と、の偏差に基づいてシフトフィードバック制御を実行して、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動して、ステップS145Aに進む。現在シフト関連量に、操作レバーの操作量に応じた加算シフト関連量を加算した値を目標シフト関連量としているので、操作量が大きな場合は偏差が大きくなってシフト動作の速度が大きくなる。また操作量が小さな場合は偏差が小さくなるのでシフト動作の速度が小さくなる。従って、オペレータは、シフト動作とローテート動作の自動同期制御中であっても、操作量(操作角度)を調整することでシフト動作の速度を調整することができる。また、目標シフト関連量の上限を+90[°]、下限を−90[°]とすることで、+90[°]または−90[°]に近づいた場合に徐々に速度を低下させて、+90[°]または−90[°]に達したところでシフト動作を停止させることができる。 In step S140A, the machine stand control device 40 executes shift feedback control based on the deviation between the target shift-related amount and the current shift-related amount, and shift motor so that the shift-related amount approaches the target shift-related amount. Is driven, and the process proceeds to step S145A. Since the target shift-related amount is the value obtained by adding the addition shift-related amount according to the operation amount of the operation lever to the shift-related amount at present, when the operation amount is large, the deviation becomes large and the speed of the shift operation becomes large. Further, when the operation amount is small, the deviation becomes small, so that the speed of the shift operation becomes small. Therefore, the operator can adjust the speed of the shift operation by adjusting the operation amount (operation angle) even during the automatic synchronization control of the shift operation and the rotate operation. In addition, by setting the upper limit of the target shift-related amount to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90. The shift operation can be stopped when it reaches [°] or −90 [°].

具体的には、機台制御装置40は、目標シフト関連量T2s(=+40[°])と、現在シフト関連量P2s(=+30[°])と、の偏差に基づいて、フィードバック制御量を求め、求めた制御量に基づいて、シフト関連量が目標シフト関連量に近づくようにシフトモータを駆動する。また、ステップS140Aは、シフトフィードバック制御ステップに相当している。 Specifically, the machine base control device 40 determines the feedback control amount based on the deviation between the target shift-related amount T2s (= + 40 [°]) and the current shift-related amount P2s (= + 30 [°]). Based on the obtained control amount, the shift motor is driven so that the shift-related amount approaches the target shift-related amount. Further, step S140A corresponds to a shift feedback control step.

ステップS145Aにて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向(この場合、前または後ろ)及び操作量(操作角度)と、図14に示す前後操作量・加算ローテート量特性に基づいて、加算ローテート量を求める。なお、前後操作量・加算ローテート量特性は、機台制御装置40の記憶装置に記憶されている。前後操作量・加算ローテート量特性は、横軸が前後の操作量(操作角度)、縦軸が加算ローテート量とされている。なお、前後操作量・加算ローテート量特性は、図14に示す特性に限定されるものではない。 In step S145A, the machine base control device 40 determines the tilting direction (in this case, front or rear) and the operation amount (operation angle) of the operation lever based on the operation state of the operation means, and the front-rear operation amount / addition rotation shown in FIG. The added rotate amount is obtained based on the quantity characteristic. The front-rear operation amount and the addition rotation amount characteristic are stored in the storage device of the machine base control device 40. As for the front-rear operation amount / addition rotation amount characteristic, the horizontal axis is the front-rear operation amount (operation angle), and the vertical axis is the addition rotation amount. The front-rear operation amount / addition rotation amount characteristic is not limited to the characteristic shown in FIG.

具体的には、機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向=「後ろ」、操作量=θ2と、図14の前後操作量・加算ローテート量特性より、加算ローテート量=−R2r[°]を求める。 Specifically, the machine base control device 40 has an addition rotation based on the tilt direction of the operation lever = "rear" and the operation amount = θ2 based on the operation state of the operation means, and the front-rear operation amount / addition rotation amount characteristics of FIG. Calculate the quantity = −R2r [°].

加算ローテート量を求めた機台制御装置40は、現在シフト関連量と、図19に示すシフト・ローテート同期基準特性とに基づいて、現在シフト関連量に対応するローテート角度である同期ローテート角度を求め、求めた同期ローテート角度に加算ローテート量を加算して目標ローテート角度を求め、求めた目標ローテート角度を記憶し、ステップS150に進む。なお、機台制御装置40は、目標ローテート角度を求める際、目標ローテート角度の上限を+90[°]、下限を−90[°]にする。 The machine stand control device 40 for obtaining the added rotation amount obtains the synchronization rotation angle, which is the rotation angle corresponding to the current shift-related amount, based on the current shift-related amount and the shift-rotate synchronization reference characteristic shown in FIG. , The added rotation amount is added to the obtained synchronous rotation angle to obtain the target rotation angle, the obtained target rotation angle is stored, and the process proceeds to step S150. When determining the target rotation angle, the machine base control device 40 sets the upper limit of the target rotation angle to +90 [°] and the lower limit to −90 [°].

具体的には、機台制御装置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 base control device 40 has P2s (= +30 [°), which is the current shift-related amount in P2 (+30, -60), which is the current fork state, on the synchronization reference line S in FIG. ]), P2r (= −30 [°]), which is a synchronous rotation angle corresponding to the rotation angle, is obtained. Then, the machine base control device 40 obtains the target rotation angle from the synchronous rotation angle P2r (= −30 [°]) + the addition rotation angle (= −R2r), and stores the obtained target rotation angle. When this is shown in FIG. 19, the synchronous rotation angle P2r (= −30) corresponding to the current state P2 (+30, −60) + the added rotation amount (= −R2r) = the target rotation angle. Here, assuming that −R2r = −10 [°], the target rotation angle is T2r = −30-10 = −40 [°]. That is, the target shift-related quantity T2s (= +40) obtained in step S135A and T2 (+40, -40) represented by the target rotation angle T2r (= -40) obtained in step S145A are the current forks. It is a target state to go from P2 (+30, -60) of the state of. Note that step S145A corresponds to the target rotation angle calculation step.

ステップS150にて機台制御装置40は、操作手段操作状態に基づいた操作レバーの傾倒方向が前であるか否かを判定し、前である場合(Yes)はステップS155Aに進み、前でない場合(No)はステップS160Aに進む。 In step S150, the machine base control device 40 determines whether or not the tilting direction of the operating lever is forward based on the operating state of the operating means. If it is forward (Yes), the process proceeds to step S155A, and if it is not forward. (No) proceeds to step S160A.

ステップS155Aに進んだ場合、機台制御装置40は、ステップS145Aにて求めた目標ローテート角度が、現在ローテート角度よりも左旋回側(−の側)にあるか否かを判定し、左旋回側(−の側)にある場合(Yes)は処理を終了し、左旋回側(−の側)でない場合(No)はステップS165Aに進む。つまり、左ホームポジション指示が入力された際に求めた目標ローテート角度が、現在ローテート角度に対して、フォークを左ローテート動作させると判定した場合、ローテートフィードバック制御を中止(スキップ)する。 When the process proceeds to step S155A, the machine stand control device 40 determines whether or not the target rotation angle obtained in step S145A is on the left turn side (-side) of the current rotation angle, and determines whether or not the target rotation angle is on the left turn side (-side). If it is on the (− side) (Yes), the process ends, and if it is not on the left turning side (− side) (No), the process proceeds to step S165A. That is, when it is determined that the target rotation angle obtained when the left home position instruction is input causes the fork to perform the left rotation operation with respect to the current rotation angle, the rotation feedback control is stopped (skipped).

ステップS160Aに進んだ場合、機台制御装置40は、ステップS145Aにて求めた目標ローテート角度が、現在ローテート角度よりも右旋回側(+の側)にあるか否かを判定し、右旋回側(+の側)にある場合(Yes)は処理を終了し、右旋回側(+の側)でない場合(No)はステップS165Aに進む。つまり、右ホームポジション指示が入力された際に求めた目標ローテート角度が、現在ローテート角度に対して、フォークを右ローテート動作させると判定した場合、ローテートフィードバック制御を中止(スキップ)する。 When proceeding to step S160A, the machine stand control device 40 determines whether or not the target rotation angle obtained in step S145A is on the right turn side (+ side) of the current rotation angle, and turns right. If it is on the turning side (+ side) (Yes), the process ends, and if it is not on the right turning side (+ side) (No), the process proceeds to step S165A. That is, when it is determined that the target rotation angle obtained when the right home position instruction is input causes the fork to perform the right rotation operation with respect to the current rotation angle, the rotation feedback control is stopped (skipped).

具体的には、図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 base control device 40 executes the rotate feedback control based on the deviation between the target rotation angle and the current rotation angle, and causes the rotation motor to approach the target rotation angle. Drive and end the process. Since the target rotation angle is the sum of the synchronous rotation angle, which is the rotation angle corresponding to the shift-related amount, and the addition rotation amount according to the operation amount of the operating lever, the deviation becomes large when the operation amount is large. The speed of rotation operation increases. Further, when the operation amount is small, the deviation becomes small, so that the speed of the rotate operation becomes small. Further, the farther away from the synchronization reference straight line S, the larger the deviation and the faster the rotation operation speed. Therefore, the operator can adjust the speed of the rotate operation by adjusting the operation amount (operation angle) even during the automatic synchronization control of the shift operation and the rotate operation. Further, as described above, the movement to the right home position or the left home position can be executed regardless of the current shift position or rotation angle of the fork, even if the fork is not in the right home position or the left home position. In addition, by setting the upper limit of the target rotation angle to +90 [°] and the lower limit to -90 [°], the speed is gradually reduced when approaching +90 [°] or -90 [°] to +90 [°]. The rotation operation can be stopped when the temperature reaches [°] or −90 [°]. Note that step S165A corresponds to the rotate feedback control step.

なお、図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 base control device 40 is a “control device” has been described, but the “control device” may be configured by a plurality of two or more control devices. In the description of the present embodiment, the special button 44 shows an example of the button shape, but the special button 44 is not limited to the button shape and may be a switch having various shapes.

また、本実施の形態の説明に用いた数値は一例であり、この数値に限定されるものではない。 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 Forklift 10 Body 11 Body 12 Reach leg 13 Head guard 14 Rear roller 15 Front roller 16A Drive steering wheel 16B Caster wheel 16C Driven wheel 16M Travel motor 17 Cross plate 20 Mast 21 Outer mast 22 Inner mast 30 Elevating unit 30M Elevating unit Motor (shift drive)
31S Shift position detecting means 32 Arm 33 Rotate shaft 33M Rotate motor (rotate drive device)
33S Rotate angle detection means 34 Finger bar 35 Fork 36 Support 40 Machine stand control device (control device)
41 Operation lever 41S Operation state detection means 42S Elevation operation state detection means 43S Accelerator operation state detection means 42 Elevation lever 43 Accelerator lever 44 Special button 47 Monitor (display device)
48 Audio output device 49 Lamp 50 Battery

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.
請求項1に記載のフォークリフトの荷役制御方法であって、
前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、
前記フォークの向きを車体の前進方向とした場合のローテート角度を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.
請求項3に記載のフォークリフトの荷役制御装置であって、
前記フォークは、前記左向き角度から前記右向き角度まで前記右ローテート動作が可能であり、かつ、前記右向き角度から前記左向き角度まで左ローテート動作が可能であり、かつ、前記左シフト限界位置から前記右シフト限界位置まで右シフト動作が可能であり、かつ、前記右シフト限界位置から前記左シフト限界位置まで左シフト動作が可能であり、
前記フォークの向きを車体の前進方向とした場合のローテート角度は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.
JP2017186621A 2017-09-27 2017-09-27 Forklift cargo handling control method and forklift cargo handling control device Active JP6922613B2 (en)

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)

* Cited by examiner, † Cited by third party
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

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