JP7247827B2 - forklift side shift controller - Google Patents

forklift side shift controller Download PDF

Info

Publication number
JP7247827B2
JP7247827B2 JP2019167676A JP2019167676A JP7247827B2 JP 7247827 B2 JP7247827 B2 JP 7247827B2 JP 2019167676 A JP2019167676 A JP 2019167676A JP 2019167676 A JP2019167676 A JP 2019167676A JP 7247827 B2 JP7247827 B2 JP 7247827B2
Authority
JP
Japan
Prior art keywords
pallet
forklift
center
forks
coordinate system
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
JP2019167676A
Other languages
Japanese (ja)
Other versions
JP2021042071A (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 JP2019167676A priority Critical patent/JP7247827B2/en
Publication of JP2021042071A publication Critical patent/JP2021042071A/en
Application granted granted Critical
Publication of JP7247827B2 publication Critical patent/JP7247827B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Forklifts And Lifting Vehicles (AREA)

Description

本発明は、フォークリフトのサイドシフト制御装置に関する。 The present invention relates to a side shift control device for a forklift.

例えば特許文献1には、サイドシフトフォークを備えたフォークリフトが記載されている。特許文献1に記載のサイドシフトフォークは、左右1対のリフトブラケットに固定された上下1対のフィンガーバーと、これらのフィンガーバーに対して左右に移動可能なシフターと、このシフターをフィンガーバーに対して左右に移動させるシフトシリンダとを備えている。 For example, Patent Literature 1 describes a forklift equipped with side shift forks. The side shift fork described in Patent Document 1 includes a pair of upper and lower finger bars fixed to a pair of left and right lift brackets, a shifter that can move left and right with respect to these finger bars, and this shifter attached to the finger bars. and a shift cylinder for moving left and right.

特開2018-177514号公報JP 2018-177514 A

ところで、フォークリフトの荷役作業では、パレットの幅方向中央部にフォークを差し込んだ状態で、フォークによりパレットを持ち上げる必要がある。しかし、フォークリフトの自動運転において、フォークをパレットに差し込む際に、フォークとパレットとの位置関係が不明であると、パレットの幅方向中央部からずれた位置にフォークを差し込んだ状態でパレットを持ち上げる虞がある。この場合には、フォークに保持されたパレットが不安定になりやすい。 By the way, in the cargo handling work of a forklift, it is necessary to lift the pallet with the fork while inserting the fork into the central portion in the width direction of the pallet. However, in the automatic operation of a forklift, if the positional relationship between the forks and the pallet is unknown when inserting the forks into the pallet, there is a risk that the pallet will be lifted while the forks are inserted at a position shifted from the central portion in the width direction of the pallet. There is In this case, the pallet held by the forks tends to become unstable.

本発明の目的は、パレットの幅方向中央部にフォークを差し込んだ状態でパレットを持ち上げることができるフォークリフトのサイドシフト制御装置を提供することである。 SUMMARY OF THE INVENTION An object of the present invention is to provide a side shift control device for a forklift that can lift a pallet with a fork inserted in the center of the pallet in the width direction.

本発明の一態様は、1対のフォークをパレットに差し込む際に、1対のフォークを左右方向に移動させるサイドシフトシリンダを制御するフォークリフトのサイドシフト制御装置であって、パレットを検出するパレット検出部と、パレット検出部の検出データに基づいて、フォークリフトに対するパレットの姿勢を検知する姿勢検知部と、パレット検出部の検出データに基づいて、パレットの正面の幅方向中心の位置を求めると共に、パレットの正面の幅方向中心の位置と姿勢検知部により検知されたフォークリフトに対するパレットの姿勢とに基づいて、パレットの背面の幅方向中心の位置を求める位置算出部と、位置算出部により求められたパレットの正面及び背面の幅方向中心の位置を通るパレット中心線と1対のフォーク間の中心点との距離を求める距離算出部と、距離算出部により求められたパレット中心線と中心点との距離が所定値以下になるようにサイドシフトシリンダを制御する制御部とを備える。 One aspect of the present invention is a side shift control device for a forklift that controls a side shift cylinder that moves a pair of forks in the left-right direction when inserting the pair of forks into a pallet, the pallet detection detecting the pallet. , an attitude detection unit that detects the attitude of the pallet relative to the forklift based on the detection data of the pallet detection unit, and the width direction center position of the front of the pallet is obtained based on the detection data of the pallet detection unit. Based on the position of the center in the width direction of the front of the pallet and the posture of the pallet relative to the forklift detected by the posture detection unit, a position calculation unit that calculates the position of the center in the width direction of the back of the pallet, and the pallet obtained by the position calculation unit and the distance between the pallet center line and the center point obtained by the distance calculation unit, a control unit for controlling the side shift cylinder so that the is equal to or less than a predetermined value.

このようなサイドシフト制御装置においては、パレット検出部によりパレットが検出され、パレット検出部の検出データに基づいて、フォークリフトに対するパレットの姿勢が検知される。そして、パレット検出部の検出データに基づいて、パレットの正面の幅方向中心の位置が求められると共に、パレットの正面の幅方向中心の位置とフォークリフトに対するパレットの姿勢とに基づいて、パレットの背面の幅方向中心の位置が求められる。そして、パレットの正面及び背面の幅方向中心の位置を通るパレット中心線と1対のフォーク間の中心点との距離が求められ、当該距離が所定値以下になるようにサイドシフトシリンダが制御される。このため、フォークとパレットとの位置関係が把握され、1対のフォーク間の中心点がパレットの正面及び背面の幅方向中心の位置を通るパレット中心線に近づくようになる。これにより、パレットの幅方向中央部にフォークを差し込んだ状態でパレットを持ち上げることができる。 In such a side shift control device, the pallet is detected by the pallet detector, and the attitude of the pallet relative to the forklift is detected based on the detection data of the pallet detector. Then, based on the detection data of the pallet detection unit, the position of the center of the width direction of the front of the pallet is obtained, and based on the position of the center of the width direction of the front of the pallet and the attitude of the pallet with respect to the forklift, the position of the back of the pallet is obtained. The position of the center in the width direction is obtained. Then, the distance between the center line of the pallet passing through the widthwise center positions of the front and back sides of the pallet and the center point between the pair of forks is obtained, and the side shift cylinder is controlled so that the distance is equal to or less than a predetermined value. be. Therefore, the positional relationship between the forks and the pallet is grasped, and the center point between the pair of forks approaches the pallet center line passing through the positions of the widthwise centers of the front and rear surfaces of the pallet. As a result, the pallet can be lifted while the forks are inserted in the central portion in the width direction of the pallet.

位置算出部は、パレット検出部の検出データに基づいて、フォークリフトの規定位置を原点としたフォークリフト座標系におけるパレットの正面の幅方向中心の位置を第1パレット中心位置として求め、第1パレット中心位置を地球の緯度及び経度で表されるワールド座標系に変換すると共に、第1パレット中心位置とフォークリフトに対するパレットの姿勢とに基づいて、フォークリフト座標系におけるパレットの背面の幅方向中心の位置を第2パレット中心位置として求め、第2パレット中心位置をワールド座標系に変換し、距離算出部は、ワールド座標系において、パレット中心線と中心点との距離を求めてもよい。 Based on the detection data of the pallet detection unit, the position calculation unit obtains the position of the width direction center of the front surface of the pallet in the forklift coordinate system with the specified position of the forklift as the origin as the first pallet center position, and calculates the first pallet center position. to the world coordinate system represented by the latitude and longitude of the earth, and based on the first pallet center position and the attitude of the pallet with respect to the forklift, the position of the width direction center of the back surface of the pallet in the forklift coordinate system is converted to the second The second pallet center position may be determined as the pallet center position, the second pallet center position may be transformed into the world coordinate system, and the distance calculation unit may determine the distance between the pallet center line and the center point in the world coordinate system.

このような構成では、フォークリフト座標系におけるパレットの正面の幅方向中心の位置がワールド座標系に変換されると共に、フォークリフト座標系におけるパレットの背面の幅方向中心の位置がワールド座標系に変換される。そして、ワールド座標系において、パレット中心線と1対のフォーク間の中心点との距離が求められる。従って、フォークをパレットに差し込むためにフォークリフトがパレットに向かって走行するときに、フォークとパレットとの位置関係が逐次変化しても、パレットの正面及び背面の幅方向中心の位置を求め直さなくて済む。これにより、計算処理の簡素化を図ることができる。 In such a configuration, the position of the width direction center of the front surface of the pallet in the forklift coordinate system is transformed into the world coordinate system, and the position of the width direction center of the back surface of the pallet in the forklift coordinate system is transformed into the world coordinate system. . Then, in the world coordinate system, the distance between the pallet centerline and the center point between the pair of forks is determined. Therefore, when the forklift moves toward the pallet to insert the fork into the pallet, even if the positional relationship between the fork and the pallet changes sequentially, it is not necessary to re-determine the widthwise center positions of the front and rear sides of the pallet. done. Thereby, simplification of calculation processing can be achieved.

制御部は、1対のフォークがパレットに差し込まれる前に、パレット中心線と中心点との距離が所定値以下になるようにサイドシフトシリンダを制御してもよい。 The control unit may control the side shift cylinders so that the distance between the center line of the pallet and the center point is equal to or less than a predetermined value before the pair of forks are inserted into the pallet.

このような構成では、フォークがパレットに差し込まれる前に、1対のフォーク間の中心点がパレット中心線に近づくようになる。従って、フォークがパレットに差し込まれたときにフォークの先端がパレットに接触することを防止できる。 With such a configuration, the center point between a pair of forks will be close to the pallet centerline before the forks are inserted into the pallet. Therefore, it is possible to prevent the tip of the fork from contacting the pallet when the fork is inserted into the pallet.

本発明によれば、パレットの幅方向中央部にフォークを差し込んだ状態でパレットを持ち上げることができる。 ADVANTAGE OF THE INVENTION According to this invention, a pallet can be lifted in the state which inserted the fork into the center part of the width direction of a pallet.

本発明の一実施形態に係るサイドシフト制御装置を具備したフォークリフトを網パレットと共に示す概略平面図である。1 is a schematic plan view showing a forklift equipped with a side shift control device according to an embodiment of the present invention together with a net pallet; FIG. 本発明の一実施形態に係るサイドシフト制御装置を示す概略構成図である。1 is a schematic configuration diagram showing a side shift control device according to an embodiment of the present invention; FIG. 図2に示されたコントローラにより実行される制御処理手順の詳細を示すフローチャートである。3 is a flow chart showing details of a control processing procedure executed by the controller shown in FIG. 2; フォークと網パレットとの位置関係を示す概念図である。FIG. 4 is a conceptual diagram showing the positional relationship between the fork and the net pallet; フォークが網パレットの脚部に接触した状態を示す概念図である。FIG. 4 is a conceptual diagram showing a state in which the forks are in contact with the legs of the net pallet;

以下、本発明の実施形態について図面を参照して詳細に説明する。 BEST MODE FOR CARRYING OUT THE INVENTION Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings.

図1は、本発明の一実施形態に係るサイドシフト制御装置を具備したフォークリフトを網パレットと共に示す概略平面図である。図1において、フォークリフト1は、車体2と、この車体2の前側に配置され、網パレット3の荷役を行う荷役装置4とを備えている。 FIG. 1 is a schematic plan view showing a forklift equipped with a side shift control device according to one embodiment of the present invention together with a net pallet. In FIG. 1, a forklift 1 includes a vehicle body 2 and a cargo handling device 4 disposed on the front side of the vehicle body 2 for handling a net pallet 3 .

荷役装置4は、車体2の前端部に取り付けられたマスト5と、このマスト5にリフトブラケット6及びロードブラケット7を介して昇降可能に取り付けられ、網パレット3を持ち上げる1対のフォーク8と、ロードブラケット7をリフトブラケット6に対して左右方向(車幅方向)に移動させることにより、1対のフォーク8を左右方向に移動させるサイドシフトシリンダ9(図2参照)とを有している。フォーク8は、通常タイプよりも長いロングタイプのフォークである。なお、荷役装置4は、特に図示はしないが、フォーク8を昇降させるリフトシリンダも有している。 The cargo handling device 4 includes a mast 5 attached to the front end of the vehicle body 2, a pair of forks 8 attached to the mast 5 via a lift bracket 6 and a load bracket 7 so as to be able to ascend and descend, and for lifting the net pallet 3. It has a side shift cylinder 9 (see FIG. 2) for moving the pair of forks 8 in the left-right direction by moving the load bracket 7 in the left-right direction (vehicle width direction) with respect to the lift bracket 6 . The fork 8 is a long type fork longer than the normal type. The cargo handling device 4 also has a lift cylinder for raising and lowering the forks 8, although not shown.

網パレット3は、荷物を収容する略直方体形状の箱状パレットである。網パレット3は、例えばトラックの荷台に複数列で載置されている。網パレット3は、各列の奥行方向(I方向)に2つずつ配置されている。フォーク8は、ロングタイプであるため、手前側及び奥側の2つの網パレット3を一緒に持ち上げることが可能である。 The net pallet 3 is a box-shaped pallet having a substantially rectangular parallelepiped shape for accommodating packages. The mesh pallets 3 are placed in a plurality of rows, for example, on the bed of a truck. Two net pallets 3 are arranged in each row in the depth direction (I direction). Since the fork 8 is of a long type, it is possible to lift the two mesh pallets 3 on the front side and the back side together.

網パレット3は、正面3aと、この正面3aと対向する背面3bと、正面3a及び背面3bと直交する2つの側面3cとを有している。正面3aは、フォーク8により網パレット3を持ち上げる際に、フォークリフト1と向き合う面である。網パレット3の下端の4つの角部には、脚部39が設けられている。フォーク8により網パレット3を持ち上げるときは、網パレット3の左右両側に位置する脚部39間にフォーク8が差し込まれる。 The net pallet 3 has a front surface 3a, a rear surface 3b facing the front surface 3a, and two side surfaces 3c orthogonal to the front surface 3a and the rear surface 3b. The front surface 3 a faces the forklift 1 when the net pallet 3 is lifted by the forks 8 . Legs 39 are provided at four corners at the lower end of the net pallet 3 . When the net pallet 3 is lifted by the forks 8, the forks 8 are inserted between the legs 39 positioned on both left and right sides of the net pallet 3.

網パレット3の正面3aには、網パレット3の幅方向(J方向)に延びるプレート10が取り付けられている。プレート10には、2つの正方形状のマーカ11が左右両側に設けられている。なお、マーカ11の形状としては、矩形状等であってもよい。 A plate 10 extending in the width direction (J direction) of the mesh pallet 3 is attached to the front surface 3 a of the mesh pallet 3 . The plate 10 is provided with two square markers 11 on both left and right sides. Note that the shape of the marker 11 may be rectangular or the like.

図2は、本発明の一実施形態に係るサイドシフト制御装置を示す概略構成図である。図2において、本実施形態のサイドシフト制御装置12は、フォークリフト1に搭載されている。サイドシフト制御装置12は、フォークリフト1の自動運転によって網パレット3の荷役作業を行うときに、サイドシフトシリンダ9を制御する装置である。具体的には、サイドシフト制御装置12は、1対のフォーク8を網パレット3に差し込む際に、サイドシフトシリンダ9を制御する。 FIG. 2 is a schematic configuration diagram showing a side shift control device according to one embodiment of the present invention. In FIG. 2, the side shift control device 12 of this embodiment is mounted on the forklift 1. As shown in FIG. The side shift control device 12 is a device that controls the side shift cylinder 9 when the net pallet 3 is loaded and unloaded by the automatic operation of the forklift 1 . Specifically, the side shift control device 12 controls the side shift cylinder 9 when inserting the pair of forks 8 into the mesh pallet 3 .

サイドシフト制御装置12は、カメラ13と、GPS受信機14と、コントローラ15とを有している。 The sideshift control device 12 has a camera 13 , a GPS receiver 14 and a controller 15 .

カメラ13は、網パレット3を撮像し、その撮像画像データを取得する。具体的には、カメラ13は、網パレット3の正面3aに設けられた2つのマーカ11を撮像する。カメラ13は、網パレット3を検出するパレット検出部を構成する。カメラ13は、特に図示はしないが、ロードブラケット7に取り付けられている。これにより、カメラ13は、フォーク8と一緒に左右方向に移動可能である。 The camera 13 captures an image of the mesh pallet 3 and acquires the captured image data. Specifically, the camera 13 images two markers 11 provided on the front surface 3 a of the mesh pallet 3 . The camera 13 constitutes a pallet detector that detects the mesh pallet 3 . The camera 13 is attached to the load bracket 7, although not shown. Thereby, the camera 13 can move in the horizontal direction together with the fork 8 .

GPS受信機14は、GPS衛星からの信号を受信し、所定の計算を行ってフォークリフト1の現在位置を測定する。GPS受信機14は、例えばGPSを利用してフォークリフト1の方位を測定するGPS方位計を有している。なお、フォークリフト1の方位は、他の方位計を使用して測定してもよい。 The GPS receiver 14 receives signals from GPS satellites and performs predetermined calculations to determine the current position of the forklift 1 . The GPS receiver 14 has, for example, a GPS compass that measures the direction of the forklift 1 using GPS. The azimuth of the forklift 1 may be measured using another compass.

コントローラ15は、CPU、RAM、ROM及び入出力インターフェース等により構成されている。コントローラ15は、姿勢検知部16と、位置算出部17と、距離算出部18と、制御部19とを有している。 The controller 15 includes a CPU, RAM, ROM, input/output interface, and the like. The controller 15 has an orientation detection section 16 , a position calculation section 17 , a distance calculation section 18 and a control section 19 .

姿勢検知部16は、カメラ13の撮像画像データに基づいて、フォークリフト1に対する網パレット3の姿勢を検知する。カメラ13の撮像画像データは、カメラ13の検出データに相当する。 The attitude detection unit 16 detects the attitude of the net pallet 3 with respect to the forklift 1 based on the captured image data of the camera 13 . The captured image data of the camera 13 corresponds to the detection data of the camera 13 .

位置算出部17は、カメラ13の撮像画像データに基づいて、手前側に位置する網パレット3(以下、網パレット3Aという)の正面3aの幅方向中心の位置を求めると共に、手前側に位置する網パレット3Aの正面3aの幅方向中心の位置と姿勢検知部16により検知されたフォークリフト1に対する網パレット3の姿勢とに基づいて、奥側に位置する網パレット3(以下、網パレット3Bという)の背面3bの幅方向中心の位置を求める。 The position calculation unit 17 obtains the position of the center of the width direction of the front surface 3a of the net pallet 3 (hereinafter referred to as net pallet 3A) located on the near side based on the captured image data of the camera 13, Based on the position of the center of the front face 3a of the mesh pallet 3A in the width direction and the posture of the mesh pallet 3 with respect to the forklift 1 detected by the posture detection unit 16, the mesh pallet 3 (hereinafter referred to as the mesh pallet 3B) located on the back side is selected. The position of the center of the width direction of the back surface 3b of is obtained.

距離算出部18は、位置算出部17により求められた網パレット3Aの正面3aの幅方向中心の位置及び網パレット3Bの背面3bの幅方向中心の位置を通るパレット中心線と1対のフォーク8間の中心点との距離を算出する。 The distance calculation unit 18 calculates the width direction center position of the front surface 3a of the net pallet 3A and the width direction center position of the back surface 3b of the net pallet 3B obtained by the position calculation unit 17, and the pair of forks 8. Calculate the distance to the center point between

制御部19は、距離算出部18により算出されたパレット中心線と1対のフォーク間の中心点との距離が所定値以下になるようにサイドシフトシリンダ9を制御する。ここでは、制御部19は、パレット中心線と1対のフォーク間の中心点との距離がゼロになるようにサイドシフトシリンダ9を制御する。なお、所定値は、ゼロに近い正(+)の値でもよい。 The control unit 19 controls the side shift cylinder 9 so that the distance between the center line of the pallet calculated by the distance calculation unit 18 and the center point between the pair of forks is equal to or less than a predetermined value. Here, the control unit 19 controls the side shift cylinder 9 so that the distance between the center line of the pallet and the center point between the pair of forks becomes zero. Note that the predetermined value may be a positive (+) value close to zero.

図3は、コントローラ15により実行される制御処理手順の詳細を示すフローチャートである。本処理は、例えばフォークリフト1が荷役対象の網パレット3の正面側に位置した時点で実行される。つまり、本処理は、フォーク8が網パレット3に差し込まれる前に実行される。 FIG. 3 is a flow chart showing the details of the control processing procedure executed by the controller 15. As shown in FIG. This process is executed, for example, when the forklift 1 is positioned in front of the mesh pallet 3 to be handled. In other words, this process is executed before the fork 8 is inserted into the mesh pallet 3 .

図3において、コントローラ15は、まずカメラ13の撮像画像データを取得する(手順S101)。また、コントローラ15は、GPS受信機14の位置情報を取得する(手順S102)。 In FIG. 3, the controller 15 first acquires captured image data of the camera 13 (step S101). Also, the controller 15 acquires the position information of the GPS receiver 14 (step S102).

続いて、コントローラ15は、カメラ13の撮像画像データに基づいて、フォークリフト1に対する網パレット3の姿勢を検知する(手順S103)。フォークリフト1に対する網パレット3の姿勢は、図4に示されるように、フォークリフト1に対する網パレット3の傾き角θmで表される。 Subsequently, the controller 15 detects the posture of the net pallet 3 with respect to the forklift 1 based on the captured image data of the camera 13 (step S103). The posture of the mesh pallet 3 with respect to the forklift 1 is represented by the inclination angle θm of the mesh pallet 3 with respect to the forklift 1, as shown in FIG.

具体的には、フォークリフト1に対する網パレット3の傾き角θmは、フォークリフト1の前後方向と網パレット3の奥行方向とがなす角度である。フォークリフト1が網パレット3の正面3aをまっすぐ向いているときは、フォークリフト1に対する網パレット3の傾き角θmは0度となる。 Specifically, the inclination angle θm of the mesh pallet 3 with respect to the forklift 1 is the angle between the front-rear direction of the forklift 1 and the depth direction of the mesh pallet 3 . When the forklift 1 faces the front surface 3a of the net pallet 3 straight, the inclination angle θm of the net pallet 3 with respect to the forklift 1 is 0 degrees.

フォークリフト1に対する網パレット3の傾き角θmは、撮像画像データ上における2つのマーカ11の形状から検知される。フォークリフト1が網パレット3の正面3aをまっすぐ向いているときは、撮像画像データ上におけるマーカ11の形状は正方形である。しかし、フォークリフト1が網パレット3の正面3aに対して傾いているときは、撮像画像データ上におけるマーカ11の形状は、フォークリフト1に対する網パレット3の傾き角θmに応じた台形となる。 The inclination angle θm of the net pallet 3 with respect to the forklift 1 is detected from the shapes of the two markers 11 on the captured image data. When the forklift 1 faces the front 3a of the net pallet 3 straight, the shape of the marker 11 on the captured image data is square. However, when the forklift 1 is tilted with respect to the front surface 3 a of the mesh pallet 3 , the shape of the marker 11 on the captured image data becomes a trapezoid corresponding to the tilt angle θm of the mesh pallet 3 with respect to the forklift 1 .

続いて、コントローラ15は、カメラ13の撮像画像データに基づいて、図4に示されるように、フォークリフト座標系における手前側の網パレット3Aの正面3aの幅方向中心の位置Aを算出する(手順S104)。手前側の網パレット3Aの正面3aの幅方向中心の位置Aは、網パレット3Aの正面3aにおける2つのマーカ11間の中心位置である。 Subsequently, the controller 15 calculates the center position A in the width direction of the front surface 3a of the net pallet 3A on the front side in the forklift coordinate system based on the captured image data of the camera 13, as shown in FIG. S104). The widthwise center position A of the front face 3a of the net pallet 3A on the near side is the center position between the two markers 11 on the front face 3a of the net pallet 3A.

フォークリフト座標系は、フォークリフト1の規定位置を原点とした座標系である。フォークリフト1の規定位置は、フォークリフト1の中心位置(例えば前輪の車軸の車幅方向中心の位置)である。 The forklift coordinate system is a coordinate system having a specified position of the forklift 1 as an origin. The specified position of the forklift 1 is the center position of the forklift 1 (for example, the center position of the axle of the front wheel in the vehicle width direction).

フォークリフト座標系における手前側の網パレット3Aの正面3aの幅方向中心の位置A(以下、フォークリフト座標系における手前側網パレット正面中心位置Aという)は、下記式のように位置座標(xa,ya)で表される。なお、手前側網パレット正面中心位置Aは、第1パレット中心位置である。
xa=xm
ya=ym+(-act)
The position A of the width direction center of the front face 3a of the net pallet 3A on the front side in the forklift coordinate system (hereinafter referred to as the front center position A of the front side net pallet 3A in the forklift coordinate system) is represented by the following formula: position coordinates (xa, ya ). The front center position A of the net pallet on the front side is the center position of the first pallet.
x a = x m
ya = ym + (-act)

ここで、xaは、フォークリフト1の前後方向に沿った手前側網パレット正面中心位置Aの座標である。xbは、フォークリフト1の左右方向に沿った手前側網パレット正面中心位置Aの座標である。xmは、カメラ座標系におけるフォークリフト1の前後方向に沿った手前側網パレット正面中心位置Aの座標である。ymは、カメラ座標系におけるフォークリフト1の左右方向に沿った手前側網パレット正面中心位置Aの座標である。なお、上述したフォークリフト1に対する網パレット3の傾き角θmは、カメラ座標系における角度であると共に、フォークリフト座標系における角度である。 Here, xa is the coordinate of the front center position A of the net pallet on the front side along the longitudinal direction of the forklift 1 . xb is the coordinate of the front center position A of the net pallet on the front side along the left-right direction of the forklift 1; xm is the coordinate of the front center position A of the net pallet on the front side along the front-rear direction of the forklift 1 in the camera coordinate system. ym is the coordinate of the front center position A of the front side net pallet along the left-right direction of the forklift 1 in the camera coordinate system. Note that the inclination angle θm of the mesh pallet 3 with respect to the forklift 1 described above is an angle in the camera coordinate system and an angle in the forklift coordinate system.

actは、フォーク8の基準位置に対するフォーク8のサイドシフト量(左右方向の移動量)である。フォーク8の基準位置は、フォークリフト1の車幅方向の中心位置である。フォーク8は、通常は基準位置にある。actは、フォーク8を右側にシフトさせたときを正(+)としている。 act is the amount of side shift of the fork 8 with respect to the reference position of the fork 8 (the amount of movement in the left-right direction). The reference position of the fork 8 is the center position of the forklift 1 in the vehicle width direction. The forks 8 are normally in the reference position. Act is positive (+) when the fork 8 is shifted to the right.

続いて、コントローラ15は、GPS受信機14の位置情報に基づいて、フォークリフト座標系における手前側網パレット正面中心位置Aをワールド座標系に変換する(手順S105)。 Subsequently, the controller 15 transforms the front center position A of the front side net pallet in the forklift coordinate system into the world coordinate system based on the position information of the GPS receiver 14 (step S105).

ワールド座標系は、地球の緯度及び経度で表される座標系である。ワールド座標系において、フォークリフト1の現在位置の座標は(X,Y)であり、フォークリフト1の方位はθである。 The world coordinate system is a coordinate system represented by the latitude and longitude of the earth. In the world coordinate system, the coordinates of the current position of the forklift 1 are (X, Y), and the azimuth of the forklift 1 is θ.

ワールド座標系における手前側網パレット正面中心位置Aは、下記式のように位置座標(Xa,Ya)で表される。
Xa=X+xa×cosθ-ya×sinθ
Ya=Y+xa×sinθ+ya×cosθ
The front center position A of the front side net pallet in the world coordinate system is represented by position coordinates (Xa, Ya) as in the following equation.
Xa=X+xa×cos θ−ya×sin θ
Ya=Y+xa×sin θ+ya×cos θ

続いて、コントローラ15は、フォークリフト座標系における手前側網パレット正面中心位置Aとフォークリフト1に対する網パレット3の姿勢とに基づいて、図4に示されるように、フォークリフト座標系における奥側の網パレット3Bの背面3bの幅方向中心の位置Bを算出する(手順S106)。フォークリフト座標系における奥側の網パレット3Bの背面3bの幅方向中心の位置B(以下、フォークリフト座標系における奥側網パレット背面中心位置Bという)は、下記式のように位置座標(xb,yb)で表される。なお、奥側網パレット背面中心位置Bは、第2パレット中心位置である。
xb=xa+P×cosθm
yb=ya+(-act)+P×sinθm
Subsequently, based on the front center position A of the mesh pallet on the front side in the forklift coordinate system and the attitude of the mesh pallet 3 with respect to the forklift 1, the controller 15 moves the mesh pallet on the back side in the forklift coordinate system, as shown in FIG. A position B of the center in the width direction of the back surface 3b of 3B is calculated (step S106). The position B of the width direction center of the back surface 3b of the back side net pallet 3B in the forklift coordinate system (hereinafter referred to as the center position B of the back surface of the back side net pallet 3B in the forklift coordinate system) is represented by the following formula: position coordinates (xb, yb ). Note that the center position B of the back surface of the inner mesh pallet is the center position of the second pallet.
xb=xa+P×cos θm
yb = ya + (-act) + P x sin θm

ここで、xbは、フォークリフト1の前後方向に沿った奥側網パレット背面中心位置Bの座標である。ybは、フォークリフト1の左右方向に沿った奥側網パレット背面中心位置Bの座標である。Pは、手前側の網パレット3Aの正面3aから奥側の網パレット3Bの背面3bまでの距離である。 Here, xb is the coordinate of the back surface center position B of the back side net pallet along the forklift 1 longitudinal direction. yb is the coordinate of the back surface center position B of the back side mesh pallet along the left-right direction of the forklift 1 . P is the distance from the front surface 3a of the net pallet 3A on the near side to the back surface 3b of the net pallet 3B on the far side.

続いて、コントローラ15は、GPS受信機14の位置情報に基づいて、フォークリフト座標系における奥側網パレット背面中心位置Bをワールド座標系に変換する(手順S107)。ワールド座標系における奥側網パレット背面中心位置Bは、下記式のように位置座標(Xb,Yb)で表される。
Xb=X+xb×cosθ-yb×sinθ
Yb=Y+xb×sinθ+yb×cosθ
Subsequently, the controller 15 converts the back surface center position B of the inner mesh pallet in the forklift coordinate system into the world coordinate system based on the position information of the GPS receiver 14 (step S107). The back surface center position B of the inner mesh pallet in the world coordinate system is represented by position coordinates (Xb, Yb) as in the following equation.
Xb=X+xb×cos θ−yb×sin θ
Yb=Y+xb×sin θ+yb×cos θ

続いて、コントローラ15は、GPS受信機14の位置情報に基づいて、図4に示されるように、ワールド座標系における1対のフォーク8間の中心点Cを算出する(手順S108)。1対のフォーク8間の中心点Cは、具体的には、フォーク8の長さの1/2の位置における1対のフォーク8間の中心の点である。フォーク8の長さの1/2の位置は、フォーク8の延在方向(長手方向)の中間位置である。 Subsequently, the controller 15 calculates the center point C between the pair of forks 8 in the world coordinate system, as shown in FIG. 4, based on the positional information of the GPS receiver 14 (step S108). Specifically, the center point C between the pair of forks 8 is the center point between the pair of forks 8 at the half length of the forks 8 . A half length position of the fork 8 is an intermediate position in the extending direction (longitudinal direction) of the fork 8 .

ワールド座標系における1対のフォーク8間の中心点Cは、下記式のように位置座標(Xc,Yc)で表される。
Xc=X+Q×cosθ-(-act)×sinθ
Yc=Y+Q×sinθ+(-act)×cosθ
A center point C between a pair of forks 8 in the world coordinate system is represented by position coordinates (Xc, Yc) as in the following equation.
Xc=X+Q×cos θ−(−act)×sin θ
Yc = Y + Q x sin θ + (-act) x cos θ

ここで、xcは、フォークリフト1の前後方向に沿った1対のフォーク8間の中心点Cの座標である。ycは、フォークリフト1の左右方向に沿った1対のフォーク8間の中心点Cの座標である。Qは、フォークリフト1の中心位置からフォーク8の長さの1/2の位置までの距離である。 Here, xc is the coordinate of the central point C between the pair of forks 8 along the longitudinal direction of the forklift 1 . yc is the coordinate of the center point C between the pair of forks 8 along the left-right direction of the forklift 1; Q is the distance from the center position of the forklift 1 to the half length position of the fork 8 .

続いて、コントローラ15は、図4に示されるように、ワールド座標系における手前側網パレット正面中心位置Aとワールド座標系における奥側網パレット背面中心位置Bとを通るパレット中心線Gと、ワールド座標系における1対のフォーク8間の中心点Cとの距離Lを算出する(手順S109)。パレット中心線Gと中心点Cとの距離Lは、パレット中心線Gに直交する方向に沿った中心点Cからのパレット中心線Gまでの距離である。距離Lは、下記式で表される。
L=((xb-xa)(yc-ya)-(yb-ya)(xc-xa))
/(√((xa-xb)^2+(ya-yb)^2))
Subsequently, as shown in FIG. 4, the controller 15 controls the pallet center line G passing through the front center position A of the front side net pallet in the world coordinate system and the center position B of the back side of the back side net pallet in the world coordinate system, and the world coordinate system. A distance L between the pair of forks 8 and the center point C in the coordinate system is calculated (step S109). The distance L between the pallet center line G and the center point C is the distance from the center point C to the pallet center line G along the direction orthogonal to the pallet center line G. The distance L is represented by the following formula.
L=((xb-xa)(yc-ya)-(yb-ya)(xc-xa))
/(√((xa−xb)^2+(ya−yb)^2))

続いて、コントローラ15は、PID制御により距離Lが0になるようなフォーク8のサイドシフト量を決定する(手順S110)。このとき、距離L>0となる場合は、1対のフォーク8間の中心点Cがパレット中心線Gの左側に位置している。距離L<0となる場合は、1対のフォーク8間の中心点Cがパレット中心線Gの右側に位置している。 Subsequently, the controller 15 determines the side shift amount of the forks 8 by PID control so that the distance L becomes 0 (step S110). At this time, when the distance L>0, the center point C between the pair of forks 8 is located on the left side of the pallet center line G. When the distance L<0, the center point C between the pair of forks 8 is located on the right side of the pallet center line G.

続いて、コントローラ15は、手順Sで決定されたサイドシフト量に応じてサイドシフトシリンダ9を制御する(手順S111)。 Subsequently, the controller 15 controls the side shift cylinder 9 according to the side shift amount determined in procedure S (step S111).

ここで、姿勢検知部16は、手順S101,S103を実行する。位置算出部17は、手順S101,S102,S104~S107を実行する。距離算出部18は、手順S108,S109を実行する。制御部19は、手順S110,S111を実行する。 Here, the posture detection unit 16 executes steps S101 and S103. The position calculator 17 executes steps S101, S102, S104 to S107. The distance calculator 18 executes steps S108 and S109. The control unit 19 executes steps S110 and S111.

以上において、フォークリフト1が網パレット3の手前に位置すると、カメラ13により網パレット3の正面3aが撮像される。そして、カメラ13の撮像画像データに基づいて、フォークリフト1に対する網パレット3の姿勢が検知される。 In the above, when the forklift 1 is positioned in front of the net pallet 3 , the camera 13 picks up an image of the front surface 3 a of the net pallet 3 . Then, the posture of the net pallet 3 with respect to the forklift 1 is detected based on the captured image data of the camera 13 .

次いで、カメラ13の撮像画像データ及びGPS受信機14の位置情報に基づいて、フォークリフト座標系における手前側網パレット正面中心位置Aが算出され、その手前側網パレット正面中心位置Aがワールド座標系に変換される。そして、フォークリフト座標系における手前側網パレット正面中心位置A、フォークリフト1に対する網パレット3の姿勢及びGPS受信機14の位置情報に基づいて、フォークリフト座標系における奥側網パレット背面中心位置Bが算出され、その奥側網パレット背面中心位置Bがワールド座標系に変換される。 Next, based on the captured image data of the camera 13 and the position information of the GPS receiver 14, the front center position A of the front side of the net pallet in the forklift coordinate system is calculated. converted. Then, based on the front center position A of the net pallet on the front side in the forklift coordinate system, the attitude of the net pallet 3 with respect to the forklift 1, and the position information of the GPS receiver 14, the center position B on the back surface of the back side net pallet in the forklift coordinate system is calculated. , the center position B of the rear side mesh pallet back surface is transformed into the world coordinate system.

次いで、ワールド座標系において、手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bを通るパレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが算出される。そして、パレット中心線Gと中心点Cとの距離Lがゼロになるようなサイドシフト量が決定され、そのサイドシフト量に応じてサイドシフトシリンダ9が自動制御される。これにより、1対のフォーク8間の中心点Cがパレット中心線Gに一致するようになる。 Next, in the world coordinate system, the distance L between the center point C between the pair of forks 8 and the pallet center line G passing through the front side net pallet front center position A and the back side net pallet back center position B is calculated. Then, the side shift amount is determined so that the distance L between the pallet center line G and the center point C becomes zero, and the side shift cylinder 9 is automatically controlled according to the side shift amount. As a result, the center point C between the pair of forks 8 is aligned with the pallet center line G.

その状態で、特に詳述はしないが、操舵制御装置(図示せず)によって、フォークリフト1が網パレット3の正面3aに対してまっすぐ向くようにステアリング(図示せず)が自動制御されてもよい。 In this state, although not described in detail, the steering (not shown) may be automatically controlled by a steering control device (not shown) so that the forklift 1 faces straight toward the front surface 3a of the mesh pallet 3. .

その後、フォークリフト1を網パレット3に向かって前進させることで、フォーク8が網パレット3の左右両側の脚部39間に差し込まれる。そして、荷役装置4のリフトシリンダ(前述)によりフォーク8を上昇させることで、網パレット3が持ち上げられる。 After that, by advancing the forklift 1 toward the net pallet 3 , the forks 8 are inserted between the left and right leg portions 39 of the net pallet 3 . Then, the net pallet 3 is lifted by raising the fork 8 by the lift cylinder (described above) of the cargo handling device 4 .

ところで、1対のフォーク8間の中心点Cがパレット中心線Gからずれた状態で、フォーク8が網パレット3に差し込まれる場合には、図5に示されるように、フォークリフト1に対する網パレット3の傾き角θmによっては、フォーク8の先端が手前側に位置する網パレット3Aの脚部39に接触してしまう。この場合には、フォーク8により網パレット3を持ち上げることができない。 By the way, when the forks 8 are inserted into the net pallet 3 with the center point C between the pair of forks 8 deviated from the pallet center line G, the net pallet 3 is positioned against the forklift 1 as shown in FIG. Depending on the inclination angle .theta.m, the tip of the fork 8 may come into contact with the leg 39 of the net pallet 3A located on the front side. In this case, the net pallet 3 cannot be lifted by the fork 8.

これに対し、本実施形態では、カメラ13により網パレット3が撮像され、カメラ13の撮像画像データに基づいて、フォークリフト1に対する網パレット3の姿勢が検知される。そして、カメラ13の撮像画像データに基づいて、手前側網パレット正面中心位置Aが求められると共に、手前側網パレット正面中心位置Aとフォークリフト1に対する網パレット3の姿勢とに基づいて、奥側網パレット背面中心位置Bが求められる。そして、手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bを通るパレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが求められ、当該距離Lが所定値以下になるようにサイドシフトシリンダ9が制御される。このため、フォーク8と網パレット3との位置関係が把握され、1対のフォーク8間の中心点Cが手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bを通るパレット中心線Gに近づくようになる。これにより、網パレット3の幅方向中央部にフォーク8を差し込んだ状態で網パレット3を持ち上げることができる。その結果、網パレット3を安定して持ち上げることが可能となる。このとき、フォークリフト1が網パレット3の正面3aに対してまっすぐ向くように網パレット3に対するフォークリフト1の姿勢を制御することにより、網パレット3を一層安定して持ち上げることが可能となる。 On the other hand, in the present embodiment, the camera 13 captures an image of the mesh pallet 3 and the attitude of the mesh pallet 3 with respect to the forklift 1 is detected based on the captured image data of the camera 13 . Then, based on the captured image data of the camera 13, the front side net pallet front center position A is obtained, and based on the front side net pallet front center position A and the posture of the net pallet 3 with respect to the forklift 1, the back side net pallet A pallet back surface center position B is obtained. Then, the distance L between the center point C between the pair of forks 8 and the pallet center line G passing through the front center position A of the net pallet on the front side and the center position B on the back surface of the net pallet on the back side is obtained, and the distance L is a predetermined value. The side shift cylinder 9 is controlled as follows. Therefore, the positional relationship between the forks 8 and the mesh pallet 3 is grasped, and the center point C between the pair of forks 8 is the center line of the pallet that passes through the front center position A of the front side mesh pallet and the back center position B of the back side mesh pallet. Get closer to G. As a result, the net pallet 3 can be lifted with the forks 8 inserted in the center of the net pallet 3 in the width direction. As a result, the net pallet 3 can be stably lifted. At this time, by controlling the posture of the forklift 1 with respect to the net pallet 3 so that the forklift 1 faces straight toward the front surface 3a of the net pallet 3, the net pallet 3 can be lifted more stably.

また、本実施形態では、フォークリフト座標系における手前側網パレット正面中心位置Aがワールド座標系に変換されると共に、フォークリフト座標系における奥側網パレット背面中心位置Bがワールド座標系に変換される。そして、ワールド座標系において、パレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが求められる。従って、フォーク8を網パレット3に差し込むためにフォークリフト1が網パレット3に向かって走行するときに、フォーク8と網パレット3との位置関係が逐次変化しても、手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bを求め直さなくて済む。これにより、計算処理の簡素化を図ることができる。 In this embodiment, the front center position A of the net pallet in the forklift coordinate system is transformed into the world coordinate system, and the back center position B of the back net pallet in the forklift coordinate system is transformed into the world coordinate system. Then, in the world coordinate system, the distance L between the pallet center line G and the center point C between the pair of forks 8 is obtained. Therefore, when the forklift 1 travels toward the net pallet 3 to insert the fork 8 into the net pallet 3, even if the positional relationship between the fork 8 and the net pallet 3 changes sequentially, the center position of the front side of the net pallet can be maintained. It is not necessary to re-determine A and the back surface center position B of the inner mesh pallet. Thereby, simplification of calculation processing can be achieved.

また、本実施形態では、1対のフォーク8が網パレット3に差し込まれる前に、パレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが所定値以下になるようにサイドシフトシリンダ9が制御される。このため、フォーク8が網パレット3に差し込まれる前に、1対のフォーク8間の中心点Cがパレット中心線Gに近づくようになる。従って、フォーク8が網パレット3に差し込まれたときにフォーク8の先端が網パレット3に接触することを防止できる。 Further, in this embodiment, before the pair of forks 8 are inserted into the net pallet 3, the side members are arranged so that the distance L between the center line G of the pallet and the center point C between the pair of forks 8 is equal to or less than a predetermined value. Shift cylinder 9 is controlled. Therefore, before the forks 8 are inserted into the net pallet 3, the center point C between the pair of forks 8 approaches the pallet center line G. Therefore, when the fork 8 is inserted into the net pallet 3, the tip of the fork 8 can be prevented from coming into contact with the net pallet 3.

なお、本発明は、上記実施形態には限定されない。例えば上記実施形態では、網パレット3の正面3aに設けられたマーカ11をカメラ13で撮像することにより、網パレット3を検出しているが、特にその形態には限られず、ディープラーニング等を用いてカメラ13の撮像画像データから網パレット3を検出してもよい。 In addition, this invention is not limited to the said embodiment. For example, in the above-described embodiment, the mesh pallet 3 is detected by capturing the image of the marker 11 provided on the front surface 3a of the mesh pallet 3 with the camera 13. However, there is no particular limitation to this form, and deep learning or the like is used. Alternatively, the mesh pallet 3 may be detected from the captured image data of the camera 13 .

また、網パレット3を検出するパレット検出部としては、特にカメラ13には限られず、例えば網パレット3に向けてレーザを照射し、レーザの反射光を受光するレーザセンサ等を使用してもよい。 Further, the pallet detector for detecting the mesh pallet 3 is not particularly limited to the camera 13. For example, a laser sensor or the like that irradiates a laser toward the mesh pallet 3 and receives the reflected light of the laser may be used. .

また、上記実施形態では、フォークリフト座標系における手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bがワールド座標系に変換されているが、特にその形態には限られず、フォークリフト座標系において、手前側網パレット正面中心位置A及び奥側網パレット背面中心位置Bを通るパレット中心線Gと1対のフォーク8間の中心点Cとの距離Lを算出してもよい。この場合には、1対のフォーク8間の中心点Cは、固定値であり、計算不要となる。 In the above embodiment, the front center position A of the mesh pallet on the front side and the center position B on the back surface of the back mesh pallet in the forklift coordinate system are transformed into the world coordinate system, but the configuration is not particularly limited to that, and the forklift coordinate system , the distance L between the center point C between the pair of forks 8 and the pallet center line G passing through the center position A on the front side of the net pallet on the near side and the center position B on the back side of the net pallet on the back side may be calculated. In this case, the center point C between the pair of forks 8 is a fixed value and does not need to be calculated.

また、上記実施形態では、フォーク8が網パレット3に差し込まれる前に、パレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが所定値以下になるようにサイドシフトシリンダ9が制御されているが、特にその形態には限られず、網パレット3を検出することが可能であれば、フォーク8の先端側部分が網パレット3に差し込まれた状態で、パレット中心線Gと1対のフォーク8間の中心点Cとの距離Lが所定値以下になるようにサイドシフトシリンダ9を制御してもよい。 In the above embodiment, before the forks 8 are inserted into the mesh pallet 3, the side shift cylinder 9 is moved so that the distance L between the center line G of the pallet and the center point C between the pair of forks 8 is equal to or less than a predetermined value. is controlled, but is not particularly limited to its form, and if it is possible to detect the net pallet 3, the pallet center line G and The side shift cylinder 9 may be controlled so that the distance L between the pair of forks 8 and the center point C is equal to or less than a predetermined value.

また、上記実施形態では、ロングタイプのフォーク8により手前側の網パレット3Aと奥側の網パレット3Bとを一緒に持ち上げているが、本発明は、通常タイプのフォークにより1段または複数段の網パレット3を持ち上げるフォークリフトにも適用可能である。 In the above embodiment, the net pallet 3A on the front side and the net pallet 3B on the back side are lifted together by the long type forks 8. It can also be applied to a forklift that lifts the net pallet 3.

また、上記実施形態では、フォーク8により網パレット3を持ち上げているが、本発明は、網パレット3以外のパレット、例えばフォークが差し込まれる2つのパレット穴を有するプラスチック製または木製の平パレット等にも適用可能である。 In the above embodiment, the net pallet 3 is lifted by the forks 8, but the present invention can be applied to a pallet other than the net pallet 3, such as a plastic or wooden flat pallet having two pallet holes into which the forks are inserted. is also applicable.

1…フォークリフト、3,3A,3B…網パレット(パレット)、3a…正面、3b…背面、8…フォーク、9…サイドシフトシリンダ、12…サイドシフト制御装置、13…カメラ(パレット検出部)、16…姿勢検知部、17…位置算出部、18…距離算出部、19…制御部、A…手前側網パレット正面中心位置、B…奥側網パレット背面中心位置、C…中心点、G…パレット中心線。 DESCRIPTION OF SYMBOLS 1... Forklift, 3, 3A, 3B... Net pallet (pallet), 3a... Front, 3b... Back, 8... Fork, 9... Side shift cylinder, 12... Side shift control device, 13... Camera (pallet detector), 16... Attitude detection unit 17... Position calculation unit 18... Distance calculation unit 19... Control unit A... Front side mesh pallet front center position B... Back side mesh pallet rear center position C... Center point G... pallet centerline.

Claims (2)

1対のフォークをパレットに差し込む際に、前記1対のフォークを左右方向に移動させるサイドシフトシリンダを制御するフォークリフトのサイドシフト制御装置であって、
前記パレットを検出するパレット検出部と、
前記パレット検出部の検出データに基づいて、前記フォークリフトに対する前記パレットの姿勢を検知する姿勢検知部と、
前記パレット検出部の検出データに基づいて、前記パレットの正面の幅方向中心の位置を求めると共に、前記パレットの正面の幅方向中心の位置と前記姿勢検知部により検知された前記フォークリフトに対する前記パレットの姿勢とに基づいて、前記パレットの背面の幅方向中心の位置を求める位置算出部と、
前記位置算出部により求められた前記パレットの正面及び背面の幅方向中心の位置を通るパレット中心線と前記1対のフォーク間の中心点との距離を求める距離算出部と、
前記フォークリフトが前記パレットの正面側に位置した状態で、前記1対のフォークが前記パレットに差し込まれる前に、前記距離算出部により求められた前記パレット中心線と前記中心点との距離が所定値以下になるように前記サイドシフトシリンダを制御する制御部とを備えるフォークリフトのサイドシフト制御装置。
A side shift control device for a forklift that controls a side shift cylinder that moves the pair of forks in the left-right direction when inserting the pair of forks into a pallet,
a pallet detection unit that detects the pallet;
an attitude detection unit that detects the attitude of the pallet relative to the forklift based on the detection data of the pallet detection unit;
Based on the detection data of the pallet detection unit, the position of the front width direction center of the pallet is obtained, and the position of the pallet relative to the forklift detected by the front width direction center position of the pallet and the posture detection unit. a position calculation unit that obtains the position of the center of the back surface of the pallet in the width direction based on the posture;
a distance calculation unit that calculates the distance between the center point between the pair of forks and the center line of the pallet passing through the positions of the width direction centers of the front and back surfaces of the pallet obtained by the position calculation unit;
The distance between the center line of the pallet and the center point obtained by the distance calculating unit is a predetermined value before the pair of forks are inserted into the pallet while the forklift is positioned on the front side of the pallet. A sideshift control device for a forklift, comprising: a controller for controlling said sideshift cylinder to:
前記位置算出部は、前記パレット検出部の検出データに基づいて、前記フォークリフトの規定位置を原点としたフォークリフト座標系における前記パレットの正面の幅方向中心の位置を第1パレット中心位置として求め、前記第1パレット中心位置を地球の緯度及び経度で表されるワールド座標系に変換すると共に、前記第1パレット中心位置と前記フォークリフトに対する前記パレットの姿勢とに基づいて、前記フォークリフト座標系における前記パレットの背面の幅方向中心の位置を第2パレット中心位置として求め、前記第2パレット中心位置を前記ワールド座標系に変換し、
前記距離算出部は、前記ワールド座標系において、前記パレット中心線と前記中心点との距離を求める請求項1記載のフォークリフトのサイドシフト制御装置
The position calculation unit obtains, as a first pallet center position, a position of the width direction center of the front surface of the pallet in a forklift coordinate system having a specified position of the forklift as an origin, based on the detection data of the pallet detection unit. transforming the first pallet center position into a world coordinate system represented by the latitude and longitude of the earth, and based on the first pallet center position and the attitude of the pallet with respect to the forklift, the pallet in the forklift coordinate system; Obtaining the position of the center in the width direction of the back surface as the second pallet center position, transforming the second pallet center position into the world coordinate system,
2. A side shift control device for a forklift truck according to claim 1, wherein said distance calculator calculates the distance between said center line of said pallet and said center point in said world coordinate system .
JP2019167676A 2019-09-13 2019-09-13 forklift side shift controller Active JP7247827B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019167676A JP7247827B2 (en) 2019-09-13 2019-09-13 forklift side shift controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019167676A JP7247827B2 (en) 2019-09-13 2019-09-13 forklift side shift controller

Publications (2)

Publication Number Publication Date
JP2021042071A JP2021042071A (en) 2021-03-18
JP7247827B2 true JP7247827B2 (en) 2023-03-29

Family

ID=74863678

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019167676A Active JP7247827B2 (en) 2019-09-13 2019-09-13 forklift side shift controller

Country Status (1)

Country Link
JP (1) JP7247827B2 (en)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7283853B2 (en) * 2021-04-28 2023-05-30 三菱ロジスネクスト株式会社 forklift

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018158779A (en) 2017-03-22 2018-10-11 日本電気株式会社 On-vehicle device, cargo-handling machine, control circuit, control method, and program
US20180312382A1 (en) 2017-04-28 2018-11-01 Hyundai Motor Company Forklift system and control method thereof
JP2019091295A (en) 2017-11-15 2019-06-13 株式会社豊田自動織機 Image processing device

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05186200A (en) * 1992-01-16 1993-07-27 Toyota Autom Loom Works Ltd Cargo taking-up controller for forklift
JPH11278799A (en) * 1998-03-24 1999-10-12 Mitsubishi Electric Corp Loading control device for unmanned fork lift, and loading control method for unmanned fork lift

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2018158779A (en) 2017-03-22 2018-10-11 日本電気株式会社 On-vehicle device, cargo-handling machine, control circuit, control method, and program
US20180312382A1 (en) 2017-04-28 2018-11-01 Hyundai Motor Company Forklift system and control method thereof
JP2019091295A (en) 2017-11-15 2019-06-13 株式会社豊田自動織機 Image processing device

Also Published As

Publication number Publication date
JP2021042071A (en) 2021-03-18

Similar Documents

Publication Publication Date Title
JP6507894B2 (en) Travel control method at unloading in unmanned forklift and travel control device at unloading
JP6542574B2 (en) forklift
KR102359931B1 (en) Fork lifter system, and control method thereof
US7010404B2 (en) Position control apparatus and position control method for cargo carrying apparatus in industrial vehicle
EP1361190B1 (en) Camera lifting device and load handling support device of industrial vehicle, and industrial vehicle
JP7070041B2 (en) How to measure the height of the center of gravity of a forklift and the load loaded on the fork of the forklift
US20170285643A1 (en) Mobile apparatus
EP3309112B1 (en) Forklift truck and method of operating the same
JP3921968B2 (en) Position detection method and position detection apparatus
JP2020193061A (en) Cargo handling control device for forklift
JP2018058679A (en) forklift
JP2021042070A (en) Position and attitude estimation device
JP7247827B2 (en) forklift side shift controller
JP2021024728A (en) Position/posture estimation device
JP2017019595A (en) Load taking method in fork lift and fork lift
US20220375206A1 (en) Unmanned forklift
JP2008168952A (en) Positional deviation amount calculating method, crane, and carriage
JP7192706B2 (en) Position and orientation estimation device
JP7306311B2 (en) recognition device
JP7259662B2 (en) travel control device
JP2023064294A (en) Position posture estimation device
JP3858703B2 (en) Cargo work support device for industrial vehicle and industrial vehicle
JP2021120810A (en) Position detection device
JP2023137753A (en) Stacking control device
JP7287329B2 (en) forklift

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211214

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20221004

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20221012

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20221202

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20230227

R151 Written notification of patent or utility model registration

Ref document number: 7247827

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151