JP2003212493A - Marker selection device for industrial vehicle and industrial vehicle - Google Patents

Marker selection device for industrial vehicle and industrial vehicle

Info

Publication number
JP2003212493A
JP2003212493A JP2002014739A JP2002014739A JP2003212493A JP 2003212493 A JP2003212493 A JP 2003212493A JP 2002014739 A JP2002014739 A JP 2002014739A JP 2002014739 A JP2002014739 A JP 2002014739A JP 2003212493 A JP2003212493 A JP 2003212493A
Authority
JP
Japan
Prior art keywords
distance
cargo handling
sign
target point
screen
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
JP2002014739A
Other languages
Japanese (ja)
Other versions
JP3941521B2 (en
Inventor
Torahiko Yamanouchi
寅彦 山之内
Hisashi Ichijo
恒 一条
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 JP2002014739A priority Critical patent/JP3941521B2/en
Publication of JP2003212493A publication Critical patent/JP2003212493A/en
Application granted granted Critical
Publication of JP3941521B2 publication Critical patent/JP3941521B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Abstract

<P>PROBLEM TO BE SOLVED: To provide a marker selection device for an industrial vehicle and the industrial vehicle capable of setting one of markers, even though multiply, placed on side of an object to be handled as a mark for positioning a cargo handling apparatus when comprising a position control function for automatically positioning the cargo handling apparatus. <P>SOLUTION: A forklift internally contains a controller 45 and the controller 45 comprises an image control section 46. The image control section 46 comprises a distance calculation section 83 between two coordinates and a target determination section 84. The distance calculation section 83 calculates a distance between the mark and a moving target point displayed on a screen of a display device 25. When the mark is displayed on the screen of the display device 25, the target determination section 84 recognizes as a target the mark nearest to the moving target point on the screen. <P>COPYRIGHT: (C)2003,JPO

Description

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

【0001】[0001]

【発明の属する技術分野】本発明は、産業車両の標識選
定装置及び産業車両に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an industrial vehicle sign selecting device and an industrial vehicle.

【0002】[0002]

【従来の技術】例えば、この種の産業車両であるフォー
クリフトでは、多段式のマストが車体に備えられ、フォ
ーク等の荷役機器(アタッチメント)を有したキャリッ
ジがマストに沿って昇降可能に設けられている。例えば
棚の高所で荷取り作業や荷置き作業をする際は、運転者
は荷役レバー(リフトレバー)を操作して多段式マスト
を油圧駆動でスライド伸長させることにより、フォーク
等の荷役機器をマストに沿って上昇させ、荷役機器を棚
上のパレットまたは棚面に対し所定の位置関係となるよ
うに位置合わせを行う。
2. Description of the Related Art For example, in a forklift truck which is an industrial vehicle of this type, a multistage mast is provided on a vehicle body, and a carriage having a cargo handling device (attachment) such as a fork is provided so as to be able to move up and down along the mast. There is. For example, when carrying out loading work or loading work at a high place on a shelf, a driver operates a loading lever (lift lever) to slide and extend a multi-stage mast by hydraulically driving a loading device such as a fork. The cargo handling equipment is moved up along the mast, and the cargo handling equipment is aligned with the pallet on the shelf or the shelf surface so as to have a predetermined positional relationship.

【0003】この際、運手者は高所(例えば3〜6メー
トル)を仰ぎ見ながらフォークがパレットの穴または棚
面の少し上方位置に合ったかどうかを目で確認しつつ荷
役レバーを操作する必要がある。しかし、高所を下方か
ら仰ぎ見ながらフォークとパレット等が水平方向に位置
合わせされたかを目視で判断することは困難で、熟練者
でもこの位置合わせに時間を要するという問題があっ
た。
At this time, the driver operates the cargo handling lever while looking up at a high place (for example, 3 to 6 meters) and visually checking whether the fork is aligned with the pallet hole or a position slightly above the shelf surface. There is a need. However, it is difficult to visually judge whether the fork and the pallet or the like are aligned in the horizontal direction while looking up at a high place from below, and even a skilled person has a problem that this alignment takes time.

【0004】従来、フォークリフト等の産業車両の分野
において、高所に位置するフォークの位置合わせを支援
するシステムが開発されている。このシステムの一種と
して、例えば米国特許5586620号には、フォーク
を支持するキャリッジにカメラを取り付け、このカメラ
で撮影した画像を運転席から表示装置の画面を通して見
られる技術が開示されている。この場合、カメラで撮影
した高所位置の画像を表示装置の画面を通して見られる
ので、高所の荷役作業でも運転者はフォークの位置合せ
作業を比較的簡単かつ正確に行うことができる。
Conventionally, in the field of industrial vehicles such as forklifts, systems have been developed for assisting the alignment of forks located at high places. As one type of this system, for example, US Pat. No. 5,586,620 discloses a technique in which a camera is attached to a carriage that supports a fork, and an image captured by the camera can be viewed from a driver's seat through a screen of a display device. In this case, the image of the high position photographed by the camera can be viewed through the screen of the display device, so that the driver can relatively easily and accurately perform the fork alignment work even during the cargo handling work at the high place.

【0005】[0005]

【発明が解決しようとする課題】ところで、カメラを備
えたシステムに関連して、フォークの位置合わせのさら
なる支援向上を目的とし、高所に位置するフォークの位
置合わせを自動で行うフォーク位置制御機能を装備する
ことも考えられる。この種のフォーク位置制御機能で
は、フォークの移動目標となる目印が複数存在する場合
がある。よって、フォーク位置制御機能を用いるために
は、これら複数のマークのうちどれを目標として設定す
るか決める必要がある。また、複数のマークのうち一つ
を目標として設定するとしても、その設定方法が面倒で
なく、容易にできる方法であることも必要である。
By the way, in connection with a system equipped with a camera, a fork position control function for automatically positioning a fork located at a high place for the purpose of further improving the support for positioning the fork. It is also possible to equip. In this type of fork position control function, there may be a plurality of landmarks that are the target of the fork movement. Therefore, in order to use the fork position control function, it is necessary to determine which of these plural marks is set as a target. Further, even if one of a plurality of marks is set as a target, it is necessary that the setting method is not troublesome and can be easily performed.

【0006】本発明は前記の問題点に鑑みてなされたも
のであって、その目的は、荷役機器の位置合わせを自動
で行う位置制御機能を備えた場合に、荷役対象側に設け
られた標識が複数存在していても、そのうち一つの標識
を荷役機器の位置合わせの際の目印として設定できる産
業車両の標識選定装置及び産業車両を提供することにあ
る。
The present invention has been made in view of the above-mentioned problems, and an object thereof is to provide a marker provided on the cargo-handling target side when it has a position control function for automatically aligning the cargo-handling equipment. An object of the present invention is to provide an industrial vehicle sign selection device and an industrial vehicle that can set one of the signs as a mark when aligning the cargo handling equipment even if there are a plurality of signs.

【0007】[0007]

【課題を解決するための手段】上記問題点を解決するた
めに、請求項1に記載の発明では、荷役機器の位置合わ
せを自動で行う位置制御機能を備えた産業車両の標識選
定装置であって、前記荷役機器の荷役対象を撮影する撮
影手段と、前記撮影手段により撮影された画像データを
基に、前記荷役機器を自動位置合わせする際の目印とな
る標識の画面座標上における位置を検出する標識位置検
出手段と、自動位置合わせを行う際の前記標識のあるべ
き位置を移動目標点として、前記撮影手段により撮影さ
れた画像データを基に、前記画面座標上における前記移
動目標点の位置を算出する移動目標点算出手段と、前記
標識位置検出手段及び移動目標点算出手段から求まる座
標位置を基に、前記標識と前記移動目標点との間の座標
間距離を算出する距離算出手段と、前記撮影手段により
前記標識が複数撮影された場合に、これら標識のうち前
記距離算出手段により求まる2座標間の座標間距離が最
も短い標識を、前記荷役機器の位置合わせの際の目印と
して設定する目標設定手段とを備えた。
In order to solve the above-mentioned problems, the invention according to claim 1 is an apparatus for selecting marks for industrial vehicles having a position control function for automatically aligning the positions of cargo handling equipment. And a position on the screen coordinates of a sign that serves as a mark for automatically aligning the cargo-handling equipment is detected based on image-taking means for photographing the cargo-handling target of the cargo-handling equipment and image data taken by the photographing means. The position of the movement target point on the screen coordinates on the basis of the image data taken by the photographing means, with the marker position detecting means and the position where the sign should be when performing automatic alignment as the movement target point. Based on the coordinate position obtained by the moving target point calculating means for calculating, and the marker position detecting means and the moving target point calculating means, the inter-coordinate distance between the marker and the moving target point is calculated. When a plurality of the signs are photographed by the distance calculating means and the photographing means, the sign having the shortest inter-coordinate distance between the two coordinates obtained by the distance calculating means is selected from the signs when the cargo handling equipment is aligned. And target setting means for setting as a mark of the.

【0008】この発明によれば、標識位置検出手段によ
って標識位置が検出され、移動目標点算出手段によって
移動目標点の位置が算出される。そして、距離算出手段
により標識位置と移動目標点位置との間の距離が算出さ
れ、移動目標点に最も近い標識が目標設定手段によって
荷役機器の位置合わせの際の目印として設定される。荷
役機器の位置制御機能実行時には、目標設定手段により
設定された標識を目印として荷役機器の位置合わせが行
われる。従って、複数の標識が撮影手段により撮影され
た場合、荷役機器に最も近いものが位置合わせの際の目
印として設定されることになり、複数の標識が存在する
場合であっても、そのうちの一つを位置合わせの際の目
印として設定することが可能になる。また、標識の設定
方法として、荷役機器を移動させる操作手段を操作する
ことにより、操作者が意図的に任意の標識を選択できる
ことにもなる。
According to the present invention, the marker position detecting means detects the marker position, and the moving target point calculating means calculates the position of the moving target point. Then, the distance calculation means calculates the distance between the marker position and the movement target point position, and the marker closest to the movement target point is set by the target setting means as a mark when aligning the cargo handling equipment. When the position control function of the cargo handling equipment is executed, the cargo handling equipment is aligned with the mark set by the target setting means as a mark. Therefore, when a plurality of signs are photographed by the photographing means, the one closest to the cargo handling equipment is set as a mark for alignment, and even when there are a plurality of signs, one of them is set. One can be set as a mark for alignment. Further, as a method of setting the sign, the operator can intentionally select an arbitrary sign by operating the operation means for moving the cargo handling equipment.

【0009】請求項2に記載の発明では、請求項1に記
載の発明において、前記距離算出手段は、画面座標上に
おける前記移動目標点と前記標識との間の縦座標間距離
を算出し、前記目標設定手段は、前記移動目標点の座標
位置に対して縦座標で最も近くに位置する標識を、前記
荷役機器の位置合わせの目標として設定する。
According to a second aspect of the present invention, in the first aspect of the present invention, the distance calculating means calculates an inter-ordinate distance between the moving target point and the sign on screen coordinates, The target setting means sets a marker located closest to the coordinate position of the movement target point in the ordinate as the alignment target of the cargo handling equipment.

【0010】この発明によれば、請求項1に記載の発明
の作用に加え、撮影手段によって標識が複数撮影されて
も、移動目標点に対して縦座標が最も近い標識が荷役機
器の位置合わせの目標として設定される。ところで、荷
役機器の荷役操作として運転者が最も頻繁に行う操作は
上下方向操作である。よって、標識の設定方法として荷
役機器に対し縦座標が最も近い標識を目標として設定す
るので、荷役機器の位置合わせの目標を設定する際の動
作がスムーズに行える。
According to the present invention, in addition to the operation of the invention described in claim 1, even if a plurality of markers are photographed by the photographing means, the marker whose ordinate is closest to the movement target point is aligned with the cargo handling equipment. Set as the goal of. By the way, the most frequent operation performed by the driver as the cargo handling operation of the cargo handling equipment is the vertical operation. Therefore, as the sign setting method, the sign whose ordinate is the closest to the cargo handling equipment is set as the target, so that the operation for setting the alignment target of the cargo handling equipment can be performed smoothly.

【0011】請求項3に記載の発明では、請求項1に記
載の発明において、前記距離算出手段は、画面座標上に
おける前記移動目標点と前記標識との間の実座標間距離
を算出し、前記目標設定手段は、前記移動目標点の座標
位置に対して実座標で最も近くに位置する標識を、前記
荷役機器の位置合わせの目標として設定する。
According to a third aspect of the present invention, in the first aspect of the present invention, the distance calculating means calculates an actual inter-coordinate distance between the movement target point and the sign on screen coordinates, The target setting means sets a marker located closest in real coordinates to the coordinate position of the movement target point as a target for alignment of the cargo handling equipment.

【0012】この発明によれば、請求項1に記載の発明
の作用に加え、撮影手段によって標識が複数撮影されて
も、移動目標点と標識の間の座標間距離が最も短くなる
標識が荷役機器の位置合わせの目標として設定される。
従って、画面座標上において荷役機器に対し実際の距離
が最も近い標識を、荷役機器の位置合わせの際の目標と
して設定可能になる。
According to the present invention, in addition to the operation of the first aspect of the invention, even if a plurality of markers are photographed by the photographing means, the marker which has the shortest inter-coordinate distance between the moving target point and the marker is loaded. Set as a target for device alignment.
Therefore, it is possible to set a sign whose actual distance is closest to the cargo handling equipment on the screen coordinates as a target when aligning the cargo handling equipment.

【0013】請求項4に記載の発明では、請求項1〜3
のうちいずれか一項に記載の発明において、前記撮影手
段により撮影された画像データを基に、前記標識の画面
座標上におけるサイズを検出する標識サイズ検出手段を
備え、前記移動目標点算出手段は、前記標識サイズ検出
手段から求まる前記標識の画面座標上のサイズと所定の
既知の値とを基に、画面座標上における前記移動目標点
の位置を算出する。
According to the invention described in claim 4, claims 1 to 3
In the invention described in any one of the above, based on the image data captured by the image capturing means, a marker size detecting means for detecting the size of the marker on the screen coordinates is provided, and the movement target point calculating means is The position of the moving target point on the screen coordinates is calculated based on the size of the sign on the screen coordinates obtained by the sign size detection means and a predetermined known value.

【0014】この発明によれば、請求項1〜3のうちい
ずれか一項に記載の発明の作用に加え、標識サイズ検出
手段により標識の画面座標上におけるサイズが検出され
る。そして、画面座標上の標識のサイズに基づき、移動
目標点算出手段により移動目標点の位置が算出される。
According to the present invention, in addition to the operation of the invention described in any one of claims 1 to 3, the size of the marker on the screen coordinates is detected by the marker size detecting means. Then, the position of the moving target point is calculated by the moving target point calculating means based on the size of the marker on the screen coordinates.

【0015】請求項5に記載の発明では、請求項1〜4
のうちいずれか一項に記載の発明において、前記撮影手
段により撮影された画像を表示する表示手段と、前記移
動目標点算出手段から求まる移動目標点を、前記表示手
段の画面上に描画として表示する描画手段とを備え、前
記距離算出手段は、前記表示手段の画面上に表示される
前記標識と、前記描画手段により表示される前記描画と
の間の座標間距離を算出し、前記目標設定手段は、前記
描画の座標位置に対して座標間距離が最も短い標識を、
前記荷役機器の位置合わせの目標として設定する。
According to the invention described in claim 5, claims 1 to 4 are provided.
In the invention described in any one of the above, the display means for displaying the image photographed by the photographing means and the movement target point obtained from the movement target point calculation means are displayed as a drawing on the screen of the display means. The distance calculation means calculates an inter-coordinate distance between the marker displayed on the screen of the display means and the drawing displayed by the drawing means, and sets the target. Means, the coordinate distance between the coordinate position of the drawing is the shortest,
It is set as a target for alignment of the cargo handling equipment.

【0016】この発明によれば、請求項1〜4のうちい
ずれか一項に記載の発明の作用に加え、画面座標上にお
ける移動目標点の位置を示す描画が描画手段によって表
示手段に表示される。そして、表示手段に表示される標
識と描画との間の座標間距離が距離算出手段により算出
され、その座標間距離の最も短い標識が目標設定手段に
よって位置合わせの目標として設定される。
According to the present invention, in addition to the operation of the invention described in any one of claims 1 to 4, a drawing indicating the position of the movement target point on the screen coordinates is displayed on the display means by the drawing means. It Then, the inter-coordinate distance between the sign displayed on the display means and the drawing is calculated by the distance calculating means, and the sign having the shortest inter-coordinate distance is set as the alignment target by the target setting means.

【0017】請求項6に記載の発明では、請求項1,
4,5のうちいずれか一項に記載の発明において、前記
距離算出手段は、画面座標上における前記移動目標点と
前記標識との間で、縦座標間距離、実座標間距離及び横
座標間距離を算出し、複数の前記標識の一つを前記荷役
機器の位置合わせの際の目印として設定する際の設定条
件として、前記縦座標間距離、実座標間距離及び横座標
間距離の間で優先順位を設定する優先順位設定手段を備
え、前記目標設定手段は、前記優先順位設定手段によっ
て設定された優先側の座標間距離で標識設定を行い、そ
の優先側が同じであれば非優先側の座標間距離で標識設
定処理を行う。
According to the invention described in claim 6,
In the invention according to any one of 4 and 5, the distance calculation means may be arranged such that a distance between ordinates, a distance between actual coordinates, and a distance between abscissas are between the movement target point on the screen coordinates and the sign. The distance is calculated, and as one of the setting conditions when setting one of the plurality of signs as a mark when aligning the cargo handling equipment, the distance between the ordinates, the distance between the actual coordinates, and the distance between the abscissas are set. The target setting means sets a marker at the inter-coordinate distance of the priority side set by the priority setting means, and if the priority side is the same, the target setting means sets the priority order. The sign setting process is performed according to the distance between coordinates.

【0018】この発明によれば、請求項1,4,5のう
ちいずれか一項に記載の発明の作用に加え、縦座標間距
離、実座標間距離及び横座標間距離の間で、標識設定を
行う際に用いる優先順位が優先順位設定手段により設定
される。そして、目標設定手段はこの優先順位に基づき
優先順位の高い側から順に標識設定の際の条件として使
用するので、優先順位を基に標識設定が行える。
According to the present invention, in addition to the action of the invention described in any one of claims 1, 4 and 5, a marker is provided between the distance between ordinates, the distance between actual coordinates and the distance between abscissas. The priority order used when setting is set by the priority order setting means. Since the target setting means uses the priority order as a condition when setting the markers in order from the side having the highest priority, the marker setting can be performed based on the priority order.

【0019】請求項7に記載の発明では、請求項1〜6
のうちいずれか一項に記載の発明において、荷役作業の
作業状態を検出する作業状態検出手段と、前記作業状態
検出手段の検出結果を基に、荷役作業の作業モードを設
定する作業モード設定手段とを備え、前記標識位置検出
手段は、複数の前記標識のうち前記作業モード設定手段
により設定された作業モードに基づく標識を検出する。
In the invention described in claim 7, claims 1 to 6 are provided.
In the invention described in any one of the above, work state detecting means for detecting a work state of the cargo handling work, and work mode setting means for setting a work mode of the cargo handling work based on a detection result of the work state detecting means. The sign position detecting means detects a sign based on the work mode set by the work mode setting means among the plurality of signs.

【0020】この発明によれば、請求項1〜6のうちい
ずれか一項に記載の発明の作用に加え、作業状態検出手
段により荷役作業の作業状態が検出され、その検出結果
を基に作業モード設定手段によって作業モードが設定さ
れる。そして、標識位置検出手段は設定された作業モー
ドに応じた標識のみを検出する。従って、作業モードが
異なるごとに標識が存在しても、作業モードに応じた標
識のみを認識可能になる。
According to the present invention, in addition to the operation of the invention described in any one of claims 1 to 6, the work state of the cargo handling work is detected by the work state detecting means, and the work is performed based on the detection result. The work mode is set by the mode setting means. Then, the marker position detecting means detects only the marker corresponding to the set work mode. Therefore, even if a sign exists for each work mode, only the sign corresponding to the work mode can be recognized.

【0021】請求項8に記載の発明では、請求項1〜7
のうちいずれか一項に記載の発明において、前記荷役機
器を動かすために駆動される少なくとも1つのアクチュ
エータと、前記撮影手段により撮影された画像データを
基に、実座標上における前記荷役機器の位置を算出し、
目標位置に対して前記荷役機器の動かすべき距離を算出
するシフト量算出手段と、前記荷役機器が前記目標位置
に位置するように、前記シフト量算出手段により算出さ
れた距離だけ前記荷役機器を移動させるべく前記アクチ
ュエータを駆動する制御手段とを備えたことを要旨とす
る。
In the invention described in claim 8, claims 1 to 7 are provided.
In the invention described in any one of the above, the position of the cargo handling equipment on real coordinates based on at least one actuator driven to move the cargo handling equipment and image data taken by the photographing means. And calculate
A shift amount calculating means for calculating a distance to move the cargo handling equipment with respect to a target position, and moving the cargo handling equipment by the distance calculated by the shift amount calculating means so that the cargo handling equipment is located at the target position. It is a gist that the control means for driving the actuator is provided in order to do so.

【0022】この発明によれば、請求項1〜7のうちい
ずれか一項に記載の発明の作用に加え、シフト量算出手
段は実座標上における荷役機器の位置を算出し、目標位
置に対して荷役機器の動かすべき距離を算出する。そし
て、荷役機器が目標位置に位置するように、シフト量算
出手段により算出された距離だけ荷役機器を移動させる
べく制御手段がアクチュエータを駆動することによっ
て、荷役機器の位置合わせが自動で行われる。
According to the present invention, in addition to the operation of the invention described in any one of claims 1 to 7, the shift amount calculation means calculates the position of the cargo handling equipment on the real coordinates, and the shift amount calculation means calculates the position with respect to the target position. Calculate the distance that the cargo handling equipment should move. Then, the control means drives the actuator to move the cargo handling equipment by the distance calculated by the shift amount calculating means so that the cargo handling equipment is located at the target position, whereby the cargo handling equipment is automatically aligned.

【0023】請求項9に記載の発明では、請求項1〜8
のうちいずれか一項に記載の標識選定装置を備えた産業
車両。この発明によれば、請求項1〜8のうちいずれか
一項に記載の作用と同様の作用が得られる。
In the invention described in claim 9, claims 1 to 8 are provided.
An industrial vehicle equipped with the sign selecting device according to any one of the above. According to this invention, the same operation as that described in any one of claims 1 to 8 can be obtained.

【0024】[0024]

【発明の実施の形態】(第1実施形態)以下、本発明を
具体化した産業車両の標識選定装置の第1実施形態を図
1〜図14に従って説明する。
BEST MODE FOR CARRYING OUT THE INVENTION (First Embodiment) A first embodiment of an industrial vehicle sign selecting device embodying the present invention will be described below with reference to FIGS.

【0025】図1は、フォークリフトの斜視図である。
産業車両としてのリーチ型フォークリフトトラック(以
下、単にフォークリフトと記す)1は、車体2の前側に
左右一対のリーチレグ3を備え、リーチレグ3に沿って
マスト装置4が前後方向に移動(リーチ動作)可能とな
っている。車体2にはリーチシリンダ5が配設され、こ
のリーチシリンダ5によりマスト装置4がリーチ動作さ
れる。マスト装置4は荷役機器としてのフォーク6を備
え、フォーク6はマスト装置4のリーチ動作に伴い前後
方向で位置調整される。
FIG. 1 is a perspective view of a forklift.
A reach type forklift truck (hereinafter simply referred to as a forklift) 1 as an industrial vehicle includes a pair of left and right reach legs 3 on the front side of a vehicle body 2, and a mast device 4 can move in the front-back direction along the reach legs 3 (reach operation). Has become. A reach cylinder 5 is arranged on the vehicle body 2, and the mast device 4 is reached by the reach cylinder 5. The mast device 4 includes a fork 6 as a cargo handling device, and the position of the fork 6 is adjusted in the front-rear direction according to the reach operation of the mast device 4.

【0026】マスト装置4はキャリッジ7を備え、キャ
リッジ7は左右一対のリフトシリンダ8(片側のみ図
示)が駆動したときに、多段式(本例では3段式)のマ
スト9がスライド伸縮することで上下方向に移動する。
フォーク6はキャリッジ7に取り付けられ、マスト9の
スライド伸縮に伴い上下方向に位置調整される。キャリ
ッジ7にはサイドシフタ10が配設され、サイドシフタ
10はサイドシフトシリンダ11(図7参照)が駆動さ
れることで左右方向に移動可能となっている。フォーク
6は、サイドシフタ10のサイドシフトに伴い左右方向
で位置調整される。また、キャリッジ7にはティルトシ
リンダ12(図7参照)が接続され、このティルトシリ
ンダ12がティルト動作することによりフォーク6の傾
動角が調整される。なお、各種シリンダ5,8,11,
12がアクチュエータを構成する。
The mast device 4 is provided with a carriage 7, and a multistage (three stages in this example) mast 9 slides and expands and contracts when a pair of left and right lift cylinders 8 (only one side is shown) of the carriage 7 are driven. Use to move up and down.
The fork 6 is attached to the carriage 7, and its position is adjusted in the vertical direction as the mast 9 slides. A side shifter 10 is arranged on the carriage 7, and the side shifter 10 can be moved in the left-right direction by driving a side shift cylinder 11 (see FIG. 7). The position of the fork 6 is adjusted in the left-right direction according to the side shift of the side shifter 10. Further, a tilt cylinder 12 (see FIG. 7) is connected to the carriage 7, and the tilting angle of the fork 6 is adjusted by tilting the tilt cylinder 12. In addition, various cylinders 5, 8, 11,
12 constitutes an actuator.

【0027】各リーチレグ3には、先端部に前輪(従動
輪)13aが取り付けられ、車体2には後輪(駆動輪)
13bが取り付けられている。後輪13bは操舵輪を兼
ねており、車体2に配備されたバッテリ2aを電源とし
て駆動される走行用モータ14の動力により走行駆動さ
れる。車体2の後部右部分には、立席タイプの運転席1
5が設けられ、ハンドル16を操作することで後輪13
bが操舵される。
Each reach leg 3 has front wheels (driven wheels) 13a attached to its tip, and rear wheels (driving wheels) mounted on the vehicle body 2.
13b is attached. The rear wheels 13b also serve as steered wheels, and are driven to travel by the power of a traveling motor 14 driven by the battery 2a provided in the vehicle body 2 as a power source. In the right rear part of the vehicle body 2, a standing seat type driver's seat 1
5 is provided, and the rear wheel 13 can be operated by operating the handle 16.
b is steered.

【0028】フォークリフト1には、高所(高揚高範
囲)におけるフォーク6の位置合わせ操作を支援する荷
役操作支援装置(フォーク位置決め操作支援装置)17
が設けられ、この荷役操作支援装置17はサイドシフタ
10の前面中央部に組み付けられたカメラ昇降装置18
を備えている。カメラ昇降装置18は、撮影手段として
のカメラ(CCDカメラ)19を内蔵したカメラユニッ
ト20を備え、カメラユニット20はキャリッジ7の前
面中央部に組み付けられたハウジング21内に格納され
る格納位置と、ハウジング21の下端から突出する下降
位置との間を昇降するようになっている。カメラユニッ
ト20は、フォーク6が高所にあるときに、荷物(パレ
ット)を取り出す荷取り作業時に格納位置に、フォーク
6上に載せられた荷物を所定位置に載置する荷置き作業
時に下降位置に位置するように位置調整される。
The forklift 1 includes a cargo handling operation support device (fork positioning operation support device) 17 for assisting the alignment operation of the fork 6 in a high place (high lift range).
The cargo handling operation support device 17 is provided with a camera lifting device 18 mounted on the center of the front surface of the side shifter 10.
Is equipped with. The camera elevating device 18 includes a camera unit 20 having a camera (CCD camera) 19 as a photographing means built therein. The camera unit 20 is stored in a housing 21 assembled in the center of the front surface of the carriage 7, and a storage position. It is adapted to move up and down between a lower position that projects from the lower end of the housing 21. When the fork 6 is at a high place, the camera unit 20 is at the retracted position when the load (pallet) is taken out and at the lowered position when the load placed on the fork 6 is placed at a predetermined position. The position is adjusted so that it is located at.

【0029】カメラユニット20は、カメラ19の撮影
部(レンズ)22から、フォーク6の前方の荷役作業エ
リアを撮影することが可能となっている。また、ハウジ
ング21の前面下部には撮影窓23が形成され、この撮
影窓23を通して格納位置からでも荷役作業エリアの撮
影が可能である。つまり、このカメラ19によって、格
納位置と下降位置の二位置からフォーク6の正面(前
方)を撮影できる。また、サイドシフタ10のサイドシ
フト時には、フォーク6とともにカメラ昇降装置18も
左右方向に移動する。
The camera unit 20 is capable of taking an image of the cargo handling work area in front of the fork 6 from the image taking section (lens) 22 of the camera 19. A photographing window 23 is formed in the lower front portion of the housing 21. Through the photographing window 23, it is possible to photograph the cargo work area even from the storage position. That is, the camera 19 can photograph the front (front) of the fork 6 from two positions, the storage position and the lowered position. Further, when the side shifter 10 is side-shifted, the camera lifting device 18 also moves in the left-right direction together with the fork 6.

【0030】車体2の上部を覆うルーフ24には、運転
席15に立つ運転者からよく見える位置に表示手段とし
ての表示装置(液晶ディスプレイ装置)25が取り付け
られている。表示装置25の画面には、荷役作業時にカ
メラ19によって撮影されたフォーク6の前方のエリア
の画像が映し出される。運転者は、この表示装置25の
画面を見ながら荷役作業が行えるようになっている。
A display device (liquid crystal display device) 25 as a display means is attached to a roof 24 that covers the upper part of the vehicle body 2 at a position that can be easily seen by a driver standing in the driver's seat 15. On the screen of the display device 25, an image of the area in front of the fork 6 captured by the camera 19 during the cargo handling work is displayed. The driver can carry out the cargo handling work while looking at the screen of the display device 25.

【0031】図2は、カメラ19を備えたフォークリフ
ト1で荷役作業を行うときの模式側面図である。荷26
の荷役作業は、パレット27に載置された状態で行われ
る。また、荷26を載置するための棚28は多段構造と
なっており、その全長高さがフォークリフト1の高さの
2倍以上のものもある。このように棚28の全長が高い
と、高所に位置する棚部29で荷役作業を行うときに、
運転者が運転席15から荷役作業を見ることができない
場合がある。これを解消するために、カメラ19を備え
たこのフォークリフト1では、カメラ19によってフォ
ーク6の前方のエリアを撮影し、この撮影された画像を
基にしてフォーク6の位置合わせを自動で行うことで荷
役作業を支援している。
FIG. 2 is a schematic side view of the forklift 1 equipped with the camera 19 for cargo handling work. Load 26
The cargo handling work is carried out while being placed on the pallet 27. Further, the shelf 28 on which the load 26 is placed has a multi-stage structure, and there are some shelves whose total height is at least twice the height of the forklift 1. When the total length of the shelves 28 is high as described above, when carrying out cargo handling work on the shelves 29 located at high places,
There are cases where the driver cannot see the cargo handling work from the driver's seat 15. In order to eliminate this, in the forklift 1 equipped with the camera 19, the camera 19 photographs the area in front of the fork 6, and the fork 6 is automatically aligned based on the photographed image. Supports cargo handling work.

【0032】図3はマルチレバーの斜視図であり、図4
は同レバーの側面図である。インストルメントパネル上
には、操作レバー(マルチレバー)31が設けられてい
る。操作レバー31は、これ1つで走行操作と荷役操作
の全ての操作を可能とするもので複数種類の操作部を備
えている。操作レバー31は、インストルメントパネル
上の所定箇所に形成されたスロット32に沿って前後方
向に傾動するレバー本体33(図4参照)を有し、この
レバー本体33は操作しない状態ではパネル面に対し略
垂直となる中立位置にバネ(図示せず)の付勢力により
復帰する。レバー本体33の上端部にはグリップ34が
車幅方向に対し30度〜60度程度の角度をもって傾斜
する姿勢に取付けられている。
FIG. 3 is a perspective view of the multi-lever, and FIG.
[Fig. 3] is a side view of the lever. An operation lever (multi-lever) 31 is provided on the instrument panel. The operation lever 31 is capable of performing all the traveling operation and the cargo handling operation by itself, and is provided with a plurality of types of operation portions. The operation lever 31 has a lever main body 33 (see FIG. 4) that tilts in the front-back direction along a slot 32 formed at a predetermined position on the instrument panel, and this lever main body 33 is provided on the panel surface when not operated. On the other hand, it returns to a neutral position which is substantially vertical to it by the urging force of a spring (not shown). A grip 34 is attached to the upper end portion of the lever body 33 in a posture inclining at an angle of about 30 to 60 degrees with respect to the vehicle width direction.

【0033】グリップ34の左端部には、略円筒形のノ
ブ35が同図の矢印方向へ回転可能に設けられている。
また、グリップ34の左部分前縁にシーソースイッチ3
6が、グリップ34の左部分背面に十字スイッチ37
が、グリップ34の左部分前面に作動スイッチ38がそ
れぞれ設けられている。グリップ34は、運転者が右肘
を付いた状態で右手により握られる。グリップ34を握
った状態では、親指でノブ35と十字スイッチ37を操
作でき、人差し指でシーソースイッチ36を操作でき、
中指で作動スイッチ38を操作できる。
A substantially cylindrical knob 35 is provided at the left end of the grip 34 so as to be rotatable in the direction of the arrow in FIG.
Further, the seesaw switch 3 is provided on the front edge of the left portion of the grip 34.
6 is a cross switch 37 on the rear surface of the left portion of the grip 34.
However, the operation switches 38 are provided on the front surface of the left portion of the grip 34, respectively. The grip 34 is gripped by the right hand of the driver with the right elbow attached. While holding the grip 34, the thumb can operate the knob 35 and the cross switch 37, and the index finger can operate the seesaw switch 36.
The operation switch 38 can be operated with the middle finger.

【0034】グリップ34を握った右手でレバー本体3
3を前方に傾けるとフォークリフト1が前進し、レバー
本体33を後方に傾けるとフォークリフト1が後進す
る。ノブ35に形成された突起35aを親指で上方へ押
してノブ35を上側に回すとフォーク6が上昇し、親指
で突起35aを下方へ押してノブ35を下側に回すとフ
ォーク6が下降する。また、人差し指でシーソースイッ
チ36の前端36aを押すとマスト装置4が前方に移動
し、人差し指でシーソースイッチ36の後端36bを押
すとマスト装置4が後方に移動する。
The lever body 3 is held by the right hand holding the grip 34.
When 3 is tilted forward, the forklift 1 moves forward, and when the lever body 33 is tilted backward, the forklift 1 moves backward. When the thumb 35 pushes the protrusion 35a formed on the knob upward to rotate the knob 35 upward, the fork 6 moves upward, and when the thumb pushes the protrusion 35a downward to rotate the knob 35 downward, the fork 6 moves downward. When the front end 36a of the seesaw switch 36 is pushed with the index finger, the mast device 4 moves forward, and when the rear end 36b of the seesaw switch 36 is pushed with the index finger, the mast device 4 moves backward.

【0035】十字スイッチ37は上下・左右の4方向に
操作可能になっており、上下方向の操作でマスト9のテ
ィルトを操作し、左右方向の操作でサイドシフトを操作
する。親指で十字スイッチ37の上端部37aを押すと
マスト9が前傾し、十字スイッチ37の下端部37bを
押すとマスト9が後傾する。また親指で十字スイッチ3
7の右端部を押すとフォーク6が右方向に移動し、十字
スイッチ37の左端部37cを押すとフォーク6が左方
向に移動する。
The cross switch 37 can be operated in four directions of up, down, left and right. The tilt of the mast 9 is operated by the up and down operation, and the side shift is operated by the left and right operation. When the thumb pushes the upper end 37a of the cross switch 37, the mast 9 tilts forward, and when the lower end 37b of the cross switch 37 pushes, the mast 9 tilts backward. With your thumb, cross switch 3
When the right end of 7 is pushed, the fork 6 moves to the right, and when the left end 37c of the cross switch 37 is pushed, the fork 6 moves to the left.

【0036】図5は、フォークの位置合わせを自動で行
うフォーク自動位置制御についての説明図である。パレ
ット27および棚28には、パレット27、棚28に対
するフォーク6の相対位置を求めるための標識としての
マークM1,M2が付されている。つまり、パレット2
7の側面(正面)には、2つの差込孔27a,27aの
間の中央にマークM1が付されている。一方、棚28の
棚部29には、その正面中央にマークM2が付されてい
る。ここで、パレット27に付されたマークM1と、棚
28に付されたマークM2とは図形が同じであるが、白
黒が反転した模様となっている。そして、フォーク6の
位置合わせを自動で行うフォーク自動位置制御が実行さ
れると、これらマークM1,M2を目標にフォーク6が
自動で位置合わせされる。
FIG. 5 is an explanatory view of automatic fork position control for automatically positioning the forks. The pallets 27 and the shelves 28 are provided with marks M1 and M2 as markers for obtaining the relative positions of the forks 6 with respect to the pallets 27 and the shelves 28. That is, palette 2
On the side surface (front surface) of 7, a mark M1 is provided at the center between the two insertion holes 27a. On the other hand, the shelf portion 29 of the shelf 28 has a mark M2 at the center of the front surface. Here, the mark M1 on the pallet 27 and the mark M2 on the shelf 28 have the same figure, but black and white are reversed. When the fork automatic position control for automatically aligning the forks 6 is executed, the forks 6 are automatically aligned with the marks M1 and M2 as targets.

【0037】要するに、荷取り作業を行う荷取りモード
時は、パレット27に付されたマークM1を目標にし
て、フォーク6がパレット27の差込孔27aに相対す
るように自動で位置合わせが行われる。また、荷置き作
業を行う荷置きモード時は、棚28に付されたマークM
2を目標にして、フォーク6が棚部29の棚面(荷置き
面)29aの上方所定高さ(棚面29aから例えば10
〜20cm上方の高さ)に位置するとともに、2つのフ
ォーク6の中間点がマークM2と左右方向でほぼ同じ位
置となるように自動で位置合わせが行われる。フォーク
6の位置合わせは、リフトシリンダ8を駆動することで
上下方向(同図ではz方向)に、サイドシフトシリンダ
11を駆動することで左右方向(同図ではy方向)に移
動させることにより行われる。
In short, in the unloading mode for carrying out unloading work, the mark M1 on the pallet 27 is targeted and the fork 6 is automatically aligned so as to face the insertion hole 27a of the pallet 27. Be seen. Further, in the loading mode in which loading work is performed, the mark M attached to the shelf 28 is used.
Aiming at 2, the fork 6 has a predetermined height above the shelf surface (loading surface) 29a of the shelf portion 29 (for example, 10 from the shelf surface 29a).
It is positioned at a height of up to 20 cm), and the two forks 6 are automatically aligned so that the midpoint of the two forks 6 is substantially the same position as the mark M2 in the left-right direction. The fork 6 is aligned by driving the lift cylinder 8 in the vertical direction (z direction in the figure) and by driving the side shift cylinder 11 in the horizontal direction (y direction in the figure). Be seen.

【0038】図6は、カメラ19で撮影された映像が表
示された表示装置25の画面図であり、(a)がフォー
ク6の位置合わせ前、(b)が位置合わせ後である。な
お、同図は棚28に置かれたパレット27を取り出す荷
取り作業の場合であるが、荷置き作業も同様の手順で行
われる。フォーク自動位置制御時、画面40上に表示さ
れたマークM1,M2のうち、フォーク6の位置合わせ
の目標として設定されたものには、略十字状のターゲッ
ト線41が描画されることで強調して表示されている。
荷取りモードである図6では、マークM1がターゲット
線41により強調表示されている。
FIGS. 6A and 6B are screen views of the display device 25 on which the image photographed by the camera 19 is displayed. FIG. 6A is before the fork 6 is aligned, and FIG. 6B is after the aligned. It should be noted that the figure shows the case of the work of picking up the pallets 27 placed on the shelves 28, but the work of putting the load is also performed in the same procedure. During the automatic fork position control, the mark M1, M2 displayed on the screen 40, which is set as a target for the alignment of the fork 6, is emphasized by drawing a substantially cross-shaped target line 41. Is displayed.
In FIG. 6, which is the unloading mode, the mark M1 is highlighted by the target line 41.

【0039】また、画面40には、マークM1,M2が
あるべき位置を示す移動目標点42が描画されている。
そして、操作レバー31の作動スイッチ38を押してフ
ォーク自動位置制御を実行すると、カメラ19により撮
影された画像を基にしてフォーク6の自動位置合わせが
実行される。即ち、画面40上でターゲット線41によ
り強調表示されたマークM1を目標にして、移動目標点
42がマークM1と一致するようにフォーク6が上下左
右方向に自動でシフトされる。このシフト動作後、移動
目標点42とマークM1が一致すると、フォーク6が好
適な位置に配置された状態になる。なお、荷置き作業の
ときにはマークM2と移動目標点42とが一致した状態
となる。
On the screen 40, a moving target point 42 indicating the position where the marks M1 and M2 should be is drawn.
Then, when the operation switch 38 of the operation lever 31 is pressed to execute the automatic fork position control, the automatic position adjustment of the fork 6 is executed based on the image taken by the camera 19. That is, with the mark M1 highlighted on the screen 40 by the target line 41 as the target, the fork 6 is automatically shifted vertically and horizontally so that the movement target point 42 matches the mark M1. After this shift operation, when the movement target point 42 and the mark M1 coincide with each other, the fork 6 is placed in a suitable position. Note that the mark M2 and the movement target point 42 coincide with each other during the load placing work.

【0040】図7は、荷役操作支援装置17の電気的構
成図である。荷役操作支援装置17はコントローラ45
を備え、このコントローラ45は画像制御部46、荷役
制御部47、駆動回路48,49、ソレノイド駆動回路
50を備えている。荷役制御部47には、上限位置検知
スイッチ52、下限位置検知スイッチ53、マルチレバ
ー31の各ポテンショメータ54,55およびスイッチ
38,56,57、さらに揚高センサ59、作業状態検
出手段としての荷重センサ60、ティルト角センサ70
等が接続されている。また荷役制御部47には、駆動回
路48,49を介して電動アクチュエータ61および荷
役モータ(電動モータ)62がそれぞれ接続されるとと
もに、ソレノイド駆動回路50を介してオイルコントロ
ールバルブ65に組付けられた各種電磁切換弁66〜6
9のソレノイドが接続されている。なお、荷役制御部4
7が作業モード設定手段と制御手段を構成する。
FIG. 7 is an electrical block diagram of the cargo handling operation support device 17. The cargo handling operation support device 17 is a controller 45.
The controller 45 includes an image control unit 46, a cargo handling control unit 47, drive circuits 48 and 49, and a solenoid drive circuit 50. The cargo handling control unit 47 includes an upper limit position detection switch 52, a lower limit position detection switch 53, potentiometers 54 and 55 of the multi-lever 31, switches 38, 56 and 57, a lift sensor 59, and a load sensor as a work state detection unit. 60, tilt angle sensor 70
Etc. are connected. Further, an electric actuator 61 and a cargo handling motor (electric motor) 62 are connected to the cargo handling control unit 47 via drive circuits 48 and 49, respectively, and are attached to an oil control valve 65 via a solenoid drive circuit 50. Various electromagnetic switching valves 66-6
Nine solenoids are connected. The cargo handling control unit 4
7 constitutes work mode setting means and control means.

【0041】荷役制御部47は、各ポテンショメータ5
4,55、スイッチ56,57からの信号を基に電磁切
換弁66〜69の電流値制御と荷役モータ62の駆動制
御を行う。荷役モータ62の作動により荷役ポンプ(油
圧ポンプ)71が駆動されることでオイルコントロール
バルブ65に作動油が供給される。マルチレバー31の
操作信号を基にその操作に対応する各電磁切換弁66〜
69が切換え制御されることにより、リフトシリンダ
8、リーチシリンダ5、サイドシフトシリンダ11、テ
ィルトシリンダ12が油圧制御され、フォーク6の昇降
操作、リーチ操作、サイドシフト操作、ティルト操作が
可能となっている。
The cargo handling control unit 47 controls the potentiometers 5
4, 55 and the switches 56, 57 are used to control the current values of the electromagnetic switching valves 66 to 69 and drive the cargo handling motor 62. The cargo handling pump (hydraulic pump) 71 is driven by the operation of the cargo handling motor 62, so that the operating oil is supplied to the oil control valve 65. Based on the operation signal of the multi-lever 31, each electromagnetic switching valve 66-
By controlling the switching of 69, the lift cylinder 8, the reach cylinder 5, the side shift cylinder 11, and the tilt cylinder 12 are hydraulically controlled, and the lifting operation, the reach operation, the side shift operation, and the tilt operation of the fork 6 are possible. There is.

【0042】荷役制御部47は、マルチレバー操作時の
荷役制御の他、カメラユニット20の昇降制御と、フォ
ーク自動位置制御とを司る。フォーク自動位置制御は、
フォーク6を一定高さ以上に上昇させて行われる高所の
荷役作業を支援するためのもので、揚高センサ59によ
り検出されたフォーク6の揚高が設定揚高(例えば約2
メートル)以上にあるときに限り行われる。
The cargo handling control unit 47 controls the lifting and lowering control of the camera unit 20 and the automatic fork position control in addition to the cargo handling control at the time of operating the multi-lever. Fork automatic position control,
The fork 6 is for supporting the cargo handling work at a high place performed by raising the fork 6 to a certain height or more, and the lift of the fork 6 detected by the lift sensor 59 is a set lift (for example, about 2).
It is performed only when it is more than m).

【0043】揚高センサ59は、フォーク6が設定揚高
以上の高さ(揚高)にあるか否かを検出するもので、例
えば設定揚高でオン・オフが切換わる揚高スイッチから
なる。なお、揚高センサ59はフォーク6の揚高を連続
的に検出可能なセンサであってもよい。例えば揚高セン
サ59として、キャリッジ7の昇降に合わせてワイヤが
繰出し・巻取りされるリールの回転量を検出するリール
型揚高センサや、リフトシリンダ8内の油中を伝播する
超音波がピストンに反射して戻るまでの時間計測からシ
リンダストロークを検出する超音波式揚高センサを採用
することができる。
The lift sensor 59 detects whether or not the fork 6 is at a height higher than the set lift (lift), and is composed of, for example, a lift switch that is switched on and off at the set lift. . The lift sensor 59 may be a sensor capable of continuously detecting the lift of the fork 6. For example, as the lift sensor 59, a reel-type lift sensor that detects the amount of rotation of the reel on which the wire is fed and wound as the carriage 7 moves up and down, or an ultrasonic wave that propagates in the oil in the lift cylinder 8 is a piston. It is possible to employ an ultrasonic type elevation sensor that detects the cylinder stroke by measuring the time until it reflects and returns.

【0044】荷重センサ60は、フォーク6に積載され
た荷の重量(荷重)を検出するもので、本実施形態では
リフトシリンダ8内の油圧を検出する圧力センサからな
る。荷重センサ60はフォーク6上の荷の重量に応じた
電圧値の検出信号を出力する。また、ティルト角センサ
70はフォーク6の水平姿勢にあるときの角度(水平
角)を基準とした傾斜角を検出するもので、例えばポテ
ンショメータからなる。
The load sensor 60 detects the weight (load) of the load loaded on the fork 6, and is a pressure sensor for detecting the hydraulic pressure in the lift cylinder 8 in this embodiment. The load sensor 60 outputs a detection signal of a voltage value according to the weight of the load on the fork 6. The tilt angle sensor 70 detects a tilt angle based on an angle (horizontal angle) when the fork 6 is in a horizontal posture, and is composed of, for example, a potentiometer.

【0045】荷役制御部47は荷重センサ60からの検
出値を基に、フォーク自動位置制御の作業モードを荷取
りモードと荷置きモードのうちの一方に設定する。即
ち、荷役制御部47は荷重センサ60の検出値から求ま
る荷重が設定値以下(荷重W≦設定値W0)のとき、フ
ォーク6上に荷が載置されていない「荷無し」と判断し
て作業モードを「荷取りモード」に設定する。一方、荷
役制御部47は荷重センサ60の検出値から求まる荷重
が設定値を超える(荷重W>設定値W0)とき、フォー
ク6上に荷が載置されている「荷有り」と判断して作業
モードを「荷置きモード」に設定する。これにより、操
作者の操作に関係なく、フォーク6上の荷重に基づき自
動で作業モードが設定される。
The cargo handling control unit 47 sets the working mode of the automatic fork position control to one of the unloading mode and the unloading mode based on the detection value from the load sensor 60. That is, when the load obtained from the detection value of the load sensor 60 is less than or equal to the set value (load W ≦ set value W0), the cargo handling control unit 47 determines that the load is not placed on the fork 6 and “no load”. Set the work mode to "unloading mode". On the other hand, when the load obtained from the detection value of the load sensor 60 exceeds the set value (load W> set value W0), the cargo handling control unit 47 determines that the load is placed on the fork 6 as “there is a load”. Set the work mode to "loading mode". Thereby, the work mode is automatically set based on the load on the fork 6 regardless of the operation of the operator.

【0046】荷重センサ60の検出値にはキャリッジ7
等の重量分も含まれるので、空荷のときの検出値または
その検出値に少し余裕をみた値が設定値W0に設定され
ている。例えば、パレット27のみを積んだときには
「荷有り」と判定され得る設定値W0を設定することが
望ましい。なお、この作業モードの設定処理は一定時間
(例えば数10msec.)ごとに実行される。
The value detected by the load sensor 60 indicates the carriage 7
Since the weights such as the above are also included, the set value W0 is set to the detected value when there is no load or a value with a slight margin to the detected value. For example, it is desirable to set a set value W0 that can be determined as "with load" when only the pallets 27 are loaded. The work mode setting process is executed at regular intervals (for example, every several tens of msec.).

【0047】荷役制御部47はカメラユニット20の昇
降制御も実行し、フォーク6上に荷が無い荷取りモード
ではカメラユニット20を格納位置に配置し、フォーク
6上に荷が有る荷置きモードではカメラユニット20を
下降位置に配置する。カメラユニット20の昇降のため
駆動された電動アクチュエータ61は、カメラユニット
20が上限位置に達して上限位置検知スイッチ52がオ
ンしたときと、カメラユニット20が下限位置に達して
下限位置検知スイッチ53がオンしたときに駆動停止さ
れる。
The cargo handling control unit 47 also controls the raising and lowering of the camera unit 20, and arranges the camera unit 20 in the storage position in the unloading mode in which there is no load on the fork 6, and in the loading mode in which there is a load on the fork 6. The camera unit 20 is placed in the lowered position. The electric actuator 61 driven to raise and lower the camera unit 20 operates when the camera unit 20 reaches the upper limit position and the upper limit position detection switch 52 turns on, and when the camera unit 20 reaches the lower limit position and the lower limit position detection switch 53 operates. Driving is stopped when it is turned on.

【0048】一方、画像制御部46には入力側にカメラ
19が接続され、出力側に表示装置25およびスピーカ
51が接続されている。画像制御部46はカメラ19に
より撮影された画像を表示装置25に表示させるととも
に、スピーカ51に所定の音声を報知させる。また、画
像制御部46はフォーク自動位置合わせ時にフォーク6
のずれ量を求めるために、カメラ19により取り込まれ
た画像データを基に画像処理を実行する。
On the other hand, the camera 19 is connected to the input side of the image control section 46, and the display device 25 and the speaker 51 are connected to the output side thereof. The image control unit 46 causes the display device 25 to display the image captured by the camera 19 and causes the speaker 51 to notify a predetermined sound. Further, the image control unit 46 controls the fork 6 during automatic fork alignment.
In order to obtain the shift amount of the image, image processing is executed based on the image data captured by the camera 19.

【0049】画像制御部46は表示処理部75、画像処
理部76、描画手段としての描画表示部77、描画デー
タ記憶部78および音声合成部79を備えている。表示
処理部75は、カメラ19により撮影された画像が画面
に映し出されるようにカメラ19から入力した映像信号
を表示装置25に出力する。画像処理部76は表示処理
部75から画像データを入力し、その画像データを基に
画像認識処理を行い、表示装置25の画面40上(図6
(a)に示す画面座標系)のマークM1,M2の座標位
置を算出する。
The image control unit 46 includes a display processing unit 75, an image processing unit 76, a drawing display unit 77 as drawing means, a drawing data storage unit 78 and a voice synthesizing unit 79. The display processing unit 75 outputs the video signal input from the camera 19 to the display device 25 so that the image captured by the camera 19 is displayed on the screen. The image processing unit 76 inputs image data from the display processing unit 75, performs image recognition processing based on the image data, and displays it on the screen 40 of the display device 25 (see FIG. 6).
The coordinate positions of the marks M1 and M2 in the screen coordinate system shown in (a) are calculated.

【0050】描画表示部77は画像処理部76の処理結
果を基に、描画データ記憶部78に記憶された描画デー
タとして画面40上にターゲット線41や移動目標点4
2(ともに図8及び図9参照)等の描画を表示させる。
この描画表示部77は作業モードが荷取りモードのとき
画面40上に「荷取りモード」と、作業モードが荷置き
モードのとき「荷置きモード」とそれぞれ表示させる。
また、音声合成部79は音声アナウンスなどのための音
声合成処理を行ってスピーカ51に音声信号を出力す
る。
Based on the processing result of the image processing unit 76, the drawing display unit 77 displays the target line 41 and the movement target point 4 on the screen 40 as the drawing data stored in the drawing data storage unit 78.
2 (see both FIGS. 8 and 9) and the like are displayed.
The drawing display unit 77 displays the “loading mode” on the screen 40 when the work mode is the load mode, and the “loading mode” when the work mode is the load mode.
Further, the voice synthesizing unit 79 performs a voice synthesizing process for a voice announcement and outputs a voice signal to the speaker 51.

【0051】画像処理部76は、画像認識処理部80、
テンプレート記憶部81、画面座標位置算出部82、距
離算出手段としての二座標間距離算出部83および目標
設定手段としてのターゲット決定部84を備えている。
このうち、画面座標位置算出部82は画面40上のマー
ク位置を算出するマーク位置算出部85と、画面40上
の移動目標点42の位置を算出する移動目標点算出部8
6とからなる。なお、マーク位置算出部85が標識位置
検出手段と標識サイズ検出手段を構成し、移動目標点算
出部86が移動目標点算出手段に相当する。
The image processing section 76 includes an image recognition processing section 80,
A template storage unit 81, a screen coordinate position calculation unit 82, a two-coordinate distance calculation unit 83 as a distance calculation unit, and a target determination unit 84 as a target setting unit are provided.
Of these, the screen coordinate position calculation unit 82 includes a mark position calculation unit 85 that calculates the mark position on the screen 40 and a movement target point calculation unit 8 that calculates the position of the movement target point 42 on the screen 40.
It consists of 6 and 6. The mark position calculation unit 85 constitutes the marker position detection unit and the marker size detection unit, and the movement target point calculation unit 86 corresponds to the movement target point calculation unit.

【0052】一方、荷役制御部47は実座標位置算出部
87とずれ量算出部88とを備えている。以下、フォー
ク自動位置制御時に画像制御部46および荷役制御部4
7が行う処理内容を図8〜図13に従って説明する。な
お、実座標位置算出部87とずれ量算出部88とがシフ
ト量算出部を構成する。
On the other hand, the cargo handling control section 47 includes an actual coordinate position calculation section 87 and a deviation amount calculation section 88. Hereinafter, the image control unit 46 and the cargo handling control unit 4 during automatic fork position control
The processing contents performed by No. 7 will be described with reference to FIGS. The actual coordinate position calculation unit 87 and the shift amount calculation unit 88 form a shift amount calculation unit.

【0053】テンプレート記憶部81には、マークM1
用のテンプレートT1と、マークM2用のテンプレート
T2が記憶されている。即ち、図8に示すようにマーク
M1は同図(b)に示すパターンP1,P1を2個並べ
て構成され、マークM2は同図(d)に示すパターンP
2,P2を2個並べて構成されている。マークとは全体
の模様、パターンとはマークを構成する2つの模様を指
す。パターンマッチング処理に使うテンプレートT1,
T2は、パターンP1,P2と同じ模様を有する。
The mark M1 is stored in the template memory 81.
A template T1 for the mark and a template T2 for the mark M2 are stored. That is, as shown in FIG. 8, the mark M1 is formed by arranging two patterns P1 and P1 shown in FIG. 8B, and the mark M2 is the pattern P shown in FIG.
Two P2s and two P2s are arranged side by side. The mark refers to the entire pattern, and the pattern refers to the two patterns that make up the mark. Template T1, used for pattern matching processing
T2 has the same pattern as the patterns P1 and P2.

【0054】2つのマークM1,M2の各パターンP
1,P2は、互いに白と黒が反転した模様となってい
る。各パターンP1,P2は、一点を中心として放射状
に真っ直ぐ延びる複数本の境界線によって白と黒に色分
けされた模様である。本実施形態の各パターンP1,P
2は、正方形の2本の対角線により区画された4つの領
域を白と黒で色分けした模様である。但し、テンプレー
トの四角形の辺に相当する外形線は模様の一部ではな
い。
Each pattern P of the two marks M1 and M2
1 and P2 have a pattern in which white and black are reversed from each other. Each of the patterns P1 and P2 is a pattern in which white and black are color-coded by a plurality of boundary lines extending straight in a radial pattern with one point as the center. Each pattern P1, P of this embodiment
2 is a pattern in which four regions divided by two diagonal lines of a square are color-coded in white and black. However, the contour line corresponding to the side of the quadrangle of the template is not a part of the pattern.

【0055】パターンP1,P2にこの種の模様を用い
ることで、マークとカメラの距離の違いに応じて画面4
0上に映し出されるマークM1,M2の大きさが変化し
ても、その撮影されたパターンP1,P2の中心部分に
は常にテンプレートT1,T2と同サイズのパターンが
存在することになる。よって、画像処理部76は1つの
テンプレートT1,T2を用いただけのパターンマッチ
ング処理によりマークM1,M2を認識できるようにな
っている。テンプレートT1,T1は、マークM1,M
2が認識されなければならない所定サイズに設定してあ
り、所定距離以内で撮影されたマークM1,M2は全て
認識可能となっている。
By using this kind of pattern for the patterns P1 and P2, the screen 4 can be displayed according to the difference in the distance between the mark and the camera.
Even if the sizes of the marks M1 and M2 displayed on the screen 0 change, a pattern of the same size as the templates T1 and T2 always exists in the center of the photographed patterns P1 and P2. Therefore, the image processing unit 76 can recognize the marks M1 and M2 by the pattern matching process using only one template T1 and T2. Templates T1 and T1 are marks M1 and M
2 is set to a predetermined size that must be recognized, and all marks M1 and M2 taken within a predetermined distance can be recognized.

【0056】また、図10(a)は画面上に設定された
画面座標系を示す画面図であり、画面座標系では座標を
画素の単位で取り扱うものとする。また、同図における
Hは表示装置25の画面40の横方向画素数であり、V
は画面40の縦方向画素数である。一方、図10(b)
は実座標系を示す表示図であり、図10(a)の画面図
と相似関係をとっている。
FIG. 10A is a screen diagram showing a screen coordinate system set on the screen. In the screen coordinate system, coordinates are handled in pixel units. Further, H in the figure is the number of horizontal pixels of the screen 40 of the display device 25, and V
Is the number of pixels in the vertical direction of the screen 40. On the other hand, FIG.
Is a display diagram showing an actual coordinate system, and has a similarity relationship with the screen diagram of FIG.

【0057】画像認識処理部80はカメラ19により取
り込んだ画像データを基に、荷取りモードのときテンプ
レートT1を、荷置きモードのときテンプレートT2を
用いて、図9に示すように各パターンP1,P1の2箇
所で画像認識処理(パターンマッチング処理)を行う。
そして、画像認識処理部80は表示装置25の画面40
上、つまり画面座標系におけるマークM1,M2の認識
を行う。
Based on the image data captured by the camera 19, the image recognition processing unit 80 uses the template T1 in the loading mode and the template T2 in the loading mode to generate each pattern P1 as shown in FIG. Image recognition processing (pattern matching processing) is performed at two points P1.
Then, the image recognition processing unit 80 displays the screen 40 of the display device 25.
The marks M1 and M2 are recognized on the top, that is, in the screen coordinate system.

【0058】即ち、図10(a)に示すように作業モー
ドが荷取りモードでマークM1が認識された場合、画像
認識処理部80はマークM1を構成する2つのパターン
P1,P1に対しテンプレートT1により2箇所でマッ
チングし、各パターンP1,P1を認識する。なお、作
業モードが荷置きモードの場合も同様に、マークM2を
構成する2つのパターンP2,P2に対し、テンプレー
トT2による2箇所マッチングによって各パターンP
2,P2が認識される。
In other words, as shown in FIG. 10A, when the work mode is the pick-up mode and the mark M1 is recognized, the image recognition processing section 80 applies the template T1 to the two patterns P1 and P1 forming the mark M1. Thus, the patterns P1 and P1 are recognized by matching at two points. In the case where the work mode is the loading mode, similarly, the two patterns P2 and P2 forming the mark M2 are matched to each pattern P by the template T2 at two points.
2, P2 is recognized.

【0059】パターン認識後、マーク位置算出部85は
画面座標系における各パターンP1,P1の中心点(放
射中心点)の座標(I1,J1),(I2,J2)を算
出する。そして、マーク位置算出部85はこれら2つの
座標値を基にマークM2の重心座標(I,J)を算出す
るとともに、パターンP1,P1の中心間距離Dを算出
する。なお、作業モードが荷置きモードの場合もマーク
M1と同様の手順で、マークM2の重心座標とパターン
P2,P2の中心間距離とが算出される。
After the pattern recognition, the mark position calculation unit 85 calculates the coordinates (I1, J1), (I2, J2) of the center points (radiation center points) of the patterns P1, P1 in the screen coordinate system. Then, the mark position calculation unit 85 calculates the barycentric coordinates (I, J) of the mark M2 based on these two coordinate values, and also calculates the center-to-center distance D of the patterns P1 and P1. Even when the work mode is the loading mode, the barycentric coordinates of the mark M2 and the center-to-center distance of the patterns P2 and P2 are calculated in the same procedure as the mark M1.

【0060】実座標位置算出部87は画面座標系の重心
座標(I,J)と中心間距離Dの値を用い幾何変換を行
って、図6(b)に示す実座標系(XYZ座標系)にお
けるカメラ19のマークMに対する3次元相対位置座標
(Xc,Yc,Zc)を計算する。カメラ19の座標
(Xc,Yc,Zc)は次式より算出される。 Xc==−Hd/(2Dtan α) … (1) Yc=d/D(I−H/2) … (2) Zc=d/D(J−V/2) … (3) ここで、「α」は図11に示すカメラ19の水平画角の
2分の1、dは実座標系においてマークM1の2つのパ
ターンP1,P1の中心間距離である。H,V,α,d
値は既知の値であるため、I,J,D値を算出すれば、
カメラ19の3次元相対位置座標(Xc,Yc,Zc)
が求まる。この後、ずれ量算出部88は上記の(1) 〜
(3) 式を用いて求めたカメラ19の相対位置座標(X
c,Yc,Zc)を基に、フォーク6の位置ずれ量を算
出する。そして、フォーク自動位置制御を実行するとき
には、荷役制御部47はずれ量算出部88で算出された
ずれ量に基づきリフトシリンダ8とサイドシフトシリン
ダ11を駆動し、フォーク6の位置合わせを実行する。
The real coordinate position calculation unit 87 performs geometric transformation using the barycentric coordinates (I, J) of the screen coordinate system and the value of the center-to-center distance D, and the real coordinate system (XYZ coordinate system shown in FIG. 6B). ), The three-dimensional relative position coordinates (Xc, Yc, Zc) of the camera 19 with respect to the mark M are calculated. The coordinates (Xc, Yc, Zc) of the camera 19 are calculated by the following equation. Xc == − Hd / (2Dtan α) (1) Yc = d / D (I−H / 2) (2) Zc = d / D (J−V / 2) (3) Here, “ “A” is a half of the horizontal angle of view of the camera 19 shown in FIG. 11, and d is the center-to-center distance between the two patterns P1 and P1 of the mark M1 in the real coordinate system. H, V, α, d
Since the value is a known value, if I, J, D values are calculated,
Three-dimensional relative position coordinates (Xc, Yc, Zc) of the camera 19
Is required. After that, the shift amount calculation unit 88 uses the above (1) to
Relative position coordinates of the camera 19 (X
The position shift amount of the fork 6 is calculated based on (c, Yc, Zc). Then, when executing the automatic fork position control, the cargo handling control unit 47 drives the lift cylinder 8 and the side shift cylinder 11 based on the shift amount calculated by the shift amount calculation unit 88 to perform the position alignment of the fork 6.

【0061】図12は、画面40上に同一模様のマーク
が表示されたときの表示装置25の画面図であり、この
図では作業モードを荷取りモードに設定している。な
お、同図では作業モードが荷取りモードに設定されてい
る。表示装置25の画面40には同一画面上に2つのパ
レット89,90が表示されるとともに、画面40の上
部に位置するパレット89に貼着されたマークMa、下
部に位置するパレット90に貼着されたマークMbがそ
れぞれ表示されている。
FIG. 12 is a screen view of the display device 25 when the mark of the same pattern is displayed on the screen 40. In this figure, the work mode is set to the unloading mode. In the figure, the work mode is set to the unloading mode. On the screen 40 of the display device 25, two pallets 89, 90 are displayed on the same screen, and the mark Ma attached to the pallet 89 located at the upper part of the screen 40 and the pallet 90 located at the lower part of the screen 40. The marked marks Mb are displayed.

【0062】同図のように同一模様のマークが複数表示
された場合、画像認識処理部80は画面40上に表示さ
れる同一模様のマークを全て認識する。本例では、画像
認識処理部80はマークMa,Mbの2つをパターンマ
ッチング処理し、各マークMa,Mbを認識する。そし
て、パターンマッチング処理後、マーク位置算出部85
はマークMaの重心座標(p,q)と、Mbの重心座標
(r,s)を算出する。
When a plurality of marks having the same pattern are displayed as shown in the figure, the image recognition processing section 80 recognizes all the marks having the same pattern displayed on the screen 40. In this example, the image recognition processing unit 80 performs pattern matching processing on two marks Ma and Mb to recognize each mark Ma and Mb. Then, after the pattern matching processing, the mark position calculation unit 85
Calculates the barycentric coordinates (p, q) of the mark Ma and the barycentric coordinates (r, s) of Mb.

【0063】このとき、図7に示す移動目標点算出部8
6は画面40上における移動目標点42の中心座標(I
t,Jt)を算出する。以下、その算出方法を説明する
と、図13に示すようにカメラ位置C、フォーク位置
F、パレット位置P、マーク重心位置(原点)Oとお
く。そして、荷取り作業時にフォーク位置Fを目標位置
であるパレット位置Pに位置合わせするときのベクトル
FPを考えると、これらの間にはベクトルFP=ベクト
ルOP−ベクトルOC−ベクトルCFの関係がある。こ
こで、点Cと点F、点Oと点Pはそれぞれ同一鉛直線上
の位置にとるものとする。ベクトルCF,OPは、それ
ぞれカメラ位置Cとフォーク位置Fとの距離、マーク重
心位置Oとパレット位置Pとの距離に相当し、共に既知
情報である。
At this time, the movement target point calculation unit 8 shown in FIG.
6 is the center coordinate of the movement target point 42 on the screen 40 (I
t, Jt) is calculated. The calculation method will be described below, where the camera position C, the fork position F, the pallet position P, and the mark center of gravity position (origin) O are set as shown in FIG. Considering the vector FP when the fork position F is aligned with the pallet position P which is the target position during the unloading work, there is a relation of vector FP = vector OP-vector OC-vector CF between them. Here, it is assumed that the points C and F and the points O and P are on the same vertical line. The vectors CF and OP correspond to the distance between the camera position C and the fork position F and the distance between the mark center of gravity position O and the pallet position P, respectively, and are known information.

【0064】この既知情報についてベクトルOPの成分
(Xp,Yp,Zp)、ベクトルCFの成分(Xcf,Y
cf,Zcf)とそれぞれおくと、フォーク6の現在位置に
応じた位置として画面40上に表示される移動目標点の
座標(It,Jt)は次式により求まる。なお、Yp,
Zp、Ycf、Zcfは、既知の値である。 It=H/2+(Yp−Ycf)×D/d … (4) Jt=V/2+(Zp−Zcf)×D/d … (5) 同様に、荷置き作業時を考えると、フォーク6を棚部2
9に対し位置合わせする棚面29aから、所定距離(1
0〜20cm)上方位置を荷置位置Rとおくと、ベクト
ルCF,ORが既知情報となる。ベクトルORは、マー
ク重心位置Oと荷置位置Rとの距離に相当する。この既
知情報についてベクトルORの成分(Xr,Yr,Z
r)、ベクトルCFの成分(Xcf,Ycf,Zcf)とそれ
ぞれおくと、フォーク6を荷置位置Rに位置合わせする
ために画面40上でマークM2を移動させるべき移動目
標点の座標(It,Jt)は次式により求まる。なお、
Yr,Zr、Ycf、Zcfは、既知の値である。 It=H/2+(Yr−Ycf)*D/d … (6) Jt=V/2+(Zr−Zcf)*D/d … (7) そして、移動目標点42の中心座標(It,Jt)は上
記の(4) 〜(7) 式を用いて算出される。また、移動目標
点算出部86は移動目標点42の中心座標(It,J
t)の中心座標を、荷取り作業時ではデータD値を用い
て(4) ,(5) 式に従い、荷置き作業時ではデータD値を
用いて(6) ,(7) 式に従って算出する。移動目標点42
の中心座標(It,Jt)が求まると、描画表示部77
は画面40の画像上における中心座標(It,Jt)の
位置に図6や図12等に示す移動目標点42を描画す
る。なお、移動目標点42は4つの三角形が頂点を中心
を向けて等角度間隔に配置された図形として画面40上
に表示され、各4頂点で囲まれた中心点が中心座標(I
t,Jt)となる。
Regarding this known information, the components of the vector OP (Xp, Yp, Zp) and the components of the vector CF (Xcf, Y)
cf, Zcf) respectively, the coordinates (It, Jt) of the movement target point displayed on the screen 40 as the position corresponding to the current position of the fork 6 can be obtained by the following equation. In addition, Yp,
Zp, Ycf, and Zcf are known values. It = H / 2 + (Yp−Ycf) × D / d (4) Jt = V / 2 + (Zp−Zcf) × D / d (5) Similarly, considering the loading operation, the fork 6 is Shelf 2
A predetermined distance (1
When the upper position (0 to 20 cm) is set as the loading position R, the vectors CF and OR become known information. The vector OR corresponds to the distance between the mark center of gravity position O and the loading position R. For this known information, the components of the vector OR (Xr, Yr, Z
r) and the components of the vector CF (Xcf, Ycf, Zcf) respectively, the coordinates of the target point to move the mark M2 on the screen 40 to align the fork 6 with the loading position R (It, Jt) is calculated by the following equation. In addition,
Yr, Zr, Ycf, and Zcf are known values. It = H / 2 + (Yr-Ycf) * D / d (6) Jt = V / 2 + (Zr-Zcf) * D / d (7) Then, the center coordinates (It, Jt) of the movement target point 42. Is calculated using the above equations (4) to (7). Further, the movement target point calculation unit 86 determines the center coordinates (It, J) of the movement target point 42.
Calculate the center coordinates of t) according to Eqs. (4) and (5) using the data D value during unloading work and according to Eqs. (6) and (7) using the data D value during unloading work. . Movement target point 42
When the center coordinates (It, Jt) of the
Draws the movement target point 42 shown in FIGS. 6 and 12 at the position of the center coordinates (It, Jt) on the image of the screen 40. The movement target point 42 is displayed on the screen 40 as a figure in which four triangles are arranged at equal angular intervals with their vertices as their centers, and the center point surrounded by the four vertices is the center coordinate (I
t, Jt).

【0065】以上のように、マークMa,Mbの重心座
標と移動目標点42の中心座標(It,Jt)とが求ま
ると、二座標間距離算出部83はマークMaの重心座標
(p,q)と移動目標点42の中心座標(It,Jt)
との間、およびマークMbの重心座標(r,s)と移動
目標点42の中心座標(It,Jt)との間における画
面座標上の縦方向距離H1,H2をそれぞれ算出する。
そして、ターゲット決定部84は縦方向距離H1,H2
のうち距離が短い側のマーク、すなわちマークMa,M
bのうち移動目標点42に対して縦座標が一番近いマー
クをフォーク自動位置制御のターゲットとして決定す
る。なお、図13ではH1<H2の関係となっているこ
とから、マークMbがターゲットとして認識される。
As described above, when the barycentric coordinates of the marks Ma and Mb and the center coordinates (It, Jt) of the movement target point 42 are obtained, the two-coordinate distance calculation unit 83 determines the barycentric coordinates (p, q) of the mark Ma. ) And the center coordinates (It, Jt) of the movement target point 42
And the vertical distances H1 and H2 in the screen coordinates between the barycentric coordinates (r, s) of the mark Mb and the center coordinates (It, Jt) of the movement target point 42, respectively.
Then, the target determination unit 84 determines the vertical distances H1 and H2.
Of the marks having the shorter distance, that is, the marks Ma and M
Among b, the mark whose ordinate is closest to the movement target point 42 is determined as the target of the fork automatic position control. Note that the mark Mb is recognized as the target because the relationship of H1 <H2 is satisfied in FIG.

【0066】ターゲット決定後、実座標位置算出部87
はターゲットとして認識されたマークMbの画面座標系
における重心座標(r,s)と中心間距離Dの値を用い
幾何変換を行って、実座標系におけるカメラ19のマー
クMbに対する3次元相対位置座標(Xc,Yc,Z
c)を計算する。そして、ずれ量算出部88はこの実座
標系で求めたカメラ19の相対位置座標(Xc,Yc,
Zc)を基にフォーク6の位置ずれ量、つまりベクトル
FP(荷置き時はベクトルFR)を求める。そして、荷
役制御部47はベクトルFP(FR)が「0」になるよ
うな制御量指令値をソレノイド駆動回路50に出力す
る。
After the target is determined, the actual coordinate position calculation unit 87
Is a three-dimensional relative position coordinate of the camera 19 in the actual coordinate system with respect to the mark Mb in the actual coordinate system by performing geometric transformation using the barycentric coordinate (r, s) in the screen coordinate system and the value of the center-to-center distance D of the mark Mb recognized as the target. (Xc, Yc, Z
Calculate c). The shift amount calculation unit 88 then calculates the relative position coordinates (Xc, Yc,
Based on Zc), the position shift amount of the fork 6, that is, the vector FP (the vector FR at the time of loading) is obtained. Then, the cargo handling control unit 47 outputs to the solenoid drive circuit 50 a control amount command value such that the vector FP (FR) becomes “0”.

【0067】但し、本実施形態ではフォーク6の上下方
向および左右方向についてのみ自動位置制御を行い、前
後方向(リーチ方向)については運転者による手動操作
に任せている。このため、荷役制御部47はベクトルF
P(FR)のうちYZ成分を「0」とするよう算出した
フォーク6の上下方向および左右方向の各シフト量に応
じた値を、制御量指令値としてソレノイド駆動回路50
に出力する。これにより、フォーク6は上下方向および
左右方向については自動で位置合わせされ、画面40上
では移動目標点42とマークMbとが一致した状態とな
る。
However, in this embodiment, the automatic position control is performed only in the up-down direction and the left-right direction of the fork 6, and the front-rear direction (reach direction) is left to manual operation by the driver. Therefore, the cargo handling control unit 47 determines that the vector F
A value corresponding to each vertical and horizontal shift amount of the fork 6 calculated so that the YZ component of P (FR) is "0" is set as the control amount command value to the solenoid drive circuit 50.
Output to. As a result, the fork 6 is automatically aligned in the up-down direction and the left-right direction, and the moving target point 42 and the mark Mb match on the screen 40.

【0068】従って、表示装置25の画面40に表示さ
れたマークにおいて、画面40内の縦座標が移動目標点
42に最も近いものがターゲットとして決定される構成
であるので、画面40上に複数のマークが表示されたと
してもターゲットの決定が行えるようになる。つまり、
画面40上にマークが複数表示されていても、画面40
上では一つのマークがターゲットとして設定された状態
となり、同一画面上に複数のマークが表示された場合に
ターゲットが決定できないような不具合が生じない。
Therefore, in the mark displayed on the screen 40 of the display device 25, the one whose ordinate on the screen 40 is the closest to the movement target point 42 is determined as the target, and a plurality of marks are displayed on the screen 40. Even if the mark is displayed, the target can be determined. That is,
Even if a plurality of marks are displayed on the screen 40, the screen 40
In the above, one mark is set as a target, and when a plurality of marks are displayed on the same screen, the problem that the target cannot be determined does not occur.

【0069】また、フォーク6を移動操作してカメラ1
9が移動していくと、それに連れてカメラ19の移動先
に応じたマークにターゲットが順次移り変わる。本例で
はターゲットの決定方法として、移動目標点42に対し
縦座標で最も近いマークをターゲットとして決定する方
法を用いているので、荷役レバーを操作してフォーク6
を上下方向に移動させることで、運転者が意図的に任意
のマークを選択できることにもなる。さらに、フォーク
6の位置合わせとして運転者が最も頻繁に行うフォーク
操作は上下方向操作であることから、ターゲットの位置
合わせ動作もスムーズに行える。
Further, the fork 6 is moved to operate the camera 1.
As 9 moves, the target sequentially moves to the mark corresponding to the moving destination of the camera 19. In this example, as the target determination method, the mark closest to the moving target point 42 in the ordinate is determined as the target. Therefore, the cargo handling lever is operated to operate the fork 6
By moving the up and down direction, the driver can intentionally select an arbitrary mark. Furthermore, since the fork operation most frequently performed by the driver as the position adjustment of the fork 6 is the vertical operation, the target position alignment operation can be performed smoothly.

【0070】従って、この実施の形態では以下のような
効果を得ることができる。 (1)表示装置25の画面40に表示されたマークにお
いて、画面40内の縦座標が移動目標点42に最も近い
ものがターゲットとして決定される構成であるので、画
面40上に複数のマークが表示されても、そのうちの一
つをフォーク位置合わせのターゲットとして自動で決定
できる。
Therefore, the following effects can be obtained in this embodiment. (1) Among the marks displayed on the screen 40 of the display device 25, the one whose ordinate on the screen 40 is the closest to the movement target point 42 is determined as the target. Therefore, a plurality of marks are displayed on the screen 40. Even if displayed, one of them can be automatically determined as a target for fork alignment.

【0071】(2)ターゲットの決定方法として、移動
目標点42に対し縦座標で最も近いマークをターゲット
として決定する方法を用いているので、操作レバー31
を操作してフォーク6を上下方向に移動させることで、
運転者が意図的に任意のマークを選択できる。特に、フ
ォーク6の荷役作業として運転者が最も頻繁に行うフォ
ーク操作は上下操作であることから、画面座標上の縦座
標で移動目標点42に最も近いマークをターゲットとし
て設定することでスムーズにマーク選択ができる。
(2) As the target determining method, the method of determining the mark closest to the moving target point 42 in the ordinate as the target is used.
By operating to move the fork 6 up and down,
The driver can intentionally select any mark. In particular, since the fork operation that the driver most frequently performs as the loading and unloading work of the fork 6 is the up-and-down operation, by setting the mark closest to the movement target point 42 in the ordinate on the screen coordinate as the target, the mark is smoothly marked. You can choose.

【0072】(3)複数のマークのうち移動目標点42
に最も近いものが自動的にターゲットとして設定される
ので、ターゲットとして設定したいマークに対し正確に
位置合わせする必要がなく、面倒さを感じることなく簡
単にターゲットを決定することができる。
(3) Moving target point 42 of the plurality of marks
Since the target closest to is automatically set as the target, it is not necessary to accurately align the mark to be set as the target, and the target can be easily determined without feeling any trouble.

【0073】(第2実施形態)次に、第2実施形態を図
14を用いて説明する。この実施形態では、複数のマー
クのうちの一つをターゲットとして決定する際の決定条
件が前記実施形態と異なっており、他の構成は同じであ
ることから、同一構成部分には同一符号を付して詳しい
説明は省略し、異なる部分についてのみ説明する。
(Second Embodiment) Next, a second embodiment will be described with reference to FIG. In this embodiment, the determination conditions for determining one of a plurality of marks as a target are different from those in the above-described embodiment, and other configurations are the same, and therefore, the same components are denoted by the same reference numerals. Therefore, detailed description will be omitted and only different parts will be described.

【0074】図14は、画面40上に同一模様のマーク
が表示されたときの表示装置25の画面図であり、同図
では図13と同様の表示がなされている。二座標間距離
算出部83はマークMaの重心座標(p,q)と移動目
標点42の中心座標(It,Jt)との間、およびマー
クMbの重心座標(r,s)と移動目標点42の中心座
標(It,Jt)との間における画面座標上の実距離R
1,R2をそれぞれ算出する。そして、ターゲット決定
部84は実距離R1,R2のうち距離が短い側のマー
ク、すなわちマークMa,Mbのうち移動目標点42に
対して座標距離が一番近いマークをフォーク自動位置制
御のターゲットとして決定する。なお、図14ではR1
<R2の関係となっていることから、マークMbがター
ゲットとして認識される。
FIG. 14 is a screen view of the display device 25 when a mark having the same pattern is displayed on the screen 40. In FIG. 14, the same display as in FIG. 13 is displayed. The two-coordinate distance calculation unit 83 calculates the distance between the barycentric coordinates (p, q) of the mark Ma and the center coordinates (It, Jt) of the moving target point 42, and the barycentric coordinates (r, s) of the mark Mb and the moving target point. Actual distance R on screen coordinates between the center coordinates (It, Jt) of 42
1 and R2 are calculated respectively. Then, the target determination unit 84 sets the mark on the shorter distance side of the actual distances R1 and R2, that is, the mark having the closest coordinate distance to the movement target point 42 among the marks Ma and Mb as the target of the fork automatic position control. decide. Note that in FIG. 14, R1
Since the relationship is <R2, the mark Mb is recognized as the target.

【0075】ターゲット決定後、実座標位置算出部87
はターゲットとして認識されたマークMbの画面座標系
における重心座標(r,s)と中心間距離Dの値を用い
幾何変換を行って、図10(b)に示す実座標系(XY
Z座標系)におけるカメラ19のマークMに対する3次
元相対位置座標(Xc,Yc,Zc)を計算する。そし
て、ずれ量算出部88はこの実座標系で求めたカメラ1
9の相対位置座標(Xc,Yc,Zc)を基にフォーク
6の位置ずれ量を算出し、画面40上でマークMbと移
動目標点42が一致するようにフォーク自動位置制御を
実行する。
After the target is determined, the actual coordinate position calculation unit 87
Is geometrically transformed using the barycentric coordinates (r, s) in the screen coordinate system of the mark Mb recognized as the target and the value of the center-to-center distance D, and the real coordinate system (XY) shown in FIG.
Three-dimensional relative position coordinates (Xc, Yc, Zc) with respect to the mark M of the camera 19 in the Z coordinate system) are calculated. Then, the shift amount calculation unit 88 uses the camera 1 obtained in this real coordinate system.
The position deviation amount of the fork 6 is calculated based on the relative position coordinates (Xc, Yc, Zc) of 9, and the fork automatic position control is executed so that the mark Mb and the movement target point 42 match on the screen 40.

【0076】この構成においても第1実施形態の(1)
複数のマークのうちの一つをターゲットとして設定可
能、(2)荷役レバーを操作して運転者が任意にマーク
を選択可能、(3)ターゲット決定の容易化等と同様な
効果が得られる他に、次の効果が得られる。
Also in this configuration, (1) of the first embodiment
One of a plurality of marks can be set as a target, (2) the driver can arbitrarily select the mark by operating the cargo handling lever, and (3) similar effects such as facilitating target determination can be obtained. In addition, the following effects can be obtained.

【0077】(4)ターゲットの決定方法として、移動
目標点42に対し座標間距離が最も近いマークをターゲ
ットとして決定する方法を用いているので、移動目標点
に対し実質的に近いマークをターゲットとして決定する
ことができる。
(4) As the target determining method, the mark having the closest inter-coordinate distance to the moving target point 42 is used as the target. Therefore, the mark substantially close to the moving target point is used as the target. You can decide.

【0078】なお、実施形態は前記に限定されず、例え
ば次の態様に変更してもよい。 ○ 前記各実施形態において、複数のマークのうちの一
つをターゲットとして決定する際の決定方法は、移動目
標点42に対して縦座標または実座標の最も近いマーク
が目標として設定される方法に限定されない。例えば、
図15に示すように横方向距離K1,K2のうち距離が
短い側のマーク、つまりマークMa,Mbのうち移動目
標点42に対して横座標が一番近いマークをターゲット
として設定してもよい。この場合、移動目標点に対し横
座標が最も近いマークをターゲットとして決定すること
ができる。
The embodiment is not limited to the above, and may be modified into the following modes, for example. In each of the above-described embodiments, the determination method when determining one of the plurality of marks as the target is a method in which the mark having the closest ordinate or actual coordinate to the movement target point 42 is set as the target. Not limited. For example,
As shown in FIG. 15, a mark having a shorter distance among the lateral distances K1 and K2, that is, a mark having the closest abscissa to the movement target point 42 of the marks Ma and Mb may be set as a target. . In this case, the mark whose abscissa is closest to the moving target point can be determined as the target.

【0079】○ 前記各実施形態において、複数のマー
クのうちの一つをターゲットとして決定する際には、縦
座標、実座標、横座標の一つのみを判断基準とすること
に限定されない。例えば、縦座標、実座標、横座標の間
で優先順位を予め設定しておき、ターゲットの決定の際
に優先順位の高い座標間距離が同じであれば次の順位の
もので座標間距離を算出するように、優先順位の高いか
ら順に座標間距離を算出するようにしてもよい。この場
合、一つの座標間距離で判断すると、同一距離となった
ときに不具合が生じるが、優先順位を用いれば対処する
ことができる。また、組み合わせとしては縦座標と実座
標、縦座標と横座標、実座標と横座標、これら3つ全て
などどれを採用してもよい。なお、荷役制御部47が優
先順位設定手段に相当する。
In each of the above embodiments, when determining one of the plurality of marks as the target, it is not limited to using only one of the ordinate, the actual coordinate, and the abscissa as the criterion. For example, the priority order is set in advance between the ordinate, the real coordinate, and the abscissa, and if the inter-coordinate distance with the high priority is the same when determining the target, the inter-coordinate distance is calculated with the next one. As in the calculation, the inter-coordinate distance may be calculated in descending order of priority. In this case, if one coordinate distance is used for determination, a problem occurs when the distances are the same, but it can be dealt with by using the priority order. Further, as the combination, any one of ordinate and real coordinate, ordinate and abscissa, real coordinate and abscissa, all three of these may be adopted. The cargo handling control unit 47 corresponds to the priority setting means.

【0080】○ 前記各実施形態において、標識はマー
クM1,M2であることに限らず、これ以外の模様を用
いてもよい。 ○ 前記各実施形態において、フォーク6の位置として
画面40上に表示される移動目標点42は、画面40上
のマークの重心座標と2つのパターンの中心間距離Dと
を基に上記(4) 〜(7) 式から求まることに限定されな
い。例えば、各シリンダ5,8,11,12の駆動量を
算出し、それを基にフォーク6の位置を求めて移動目標
点42を算出するようにしてもよい。
In each of the above embodiments, the signs are not limited to the marks M1 and M2, and other patterns may be used. In each of the embodiments, the movement target point 42 displayed on the screen 40 as the position of the fork 6 is based on the barycentric coordinates of the mark on the screen 40 and the center-to-center distance D of the two patterns (4). ~ It is not limited to the expression (7). For example, the drive amount of each cylinder 5, 8, 11, 12 may be calculated, and the movement target point 42 may be calculated by obtaining the position of the fork 6 based on the calculated drive amount.

【0081】○ 前記各実施形態において、移動目標点
42は必ずしも画面40上に表示される必要はなく、移
動目標点42を表示させないようにしてもよい。 ○ 前記各実施形態において、作業状態検出手段は荷重
に応じた検出値を出力する荷重センサ60に限定され
ず、例えばリミットスイッチや近接スイッチ等の荷の有
無を検出するセンサであってもよい。
In each of the above embodiments, the movement target point 42 does not necessarily have to be displayed on the screen 40, and the movement target point 42 may not be displayed. In each of the above-described embodiments, the work state detection means is not limited to the load sensor 60 that outputs a detection value according to the load, and may be a sensor that detects the presence or absence of a load, such as a limit switch or a proximity switch.

【0082】○ 前記各実施形態において、作業モード
は荷取りモードと荷置きモードに限定されず、荷役作
業、運搬作業等の各種作業において必要なモードであれ
ばどのようなものでもよい。
In each of the above-described embodiments, the work mode is not limited to the unloading mode and the laying mode, and any mode may be used as long as it is a mode required for various kinds of work such as cargo handling work and transportation work.

【0083】○ 前記各実施形態において、操作レバー
は一つでリーチ操作、リフト操作、サイドシフト操作、
ティルト操作を行うことが可能なマルチレバーに限定さ
れず、各機能ごとにリーチレバー、リフトレバー、サイ
ドシフトレバー、ティルトレバーが設けられていてもよ
い。
In each of the above-mentioned embodiments, one operation lever is used for reach operation, lift operation, side shift operation,
The invention is not limited to the multi-lever capable of performing the tilt operation, and a reach lever, a lift lever, a side shift lever, and a tilt lever may be provided for each function.

【0084】○ 前記各実施形態において、フォーク自
動位置制御はリフトシリンダ8とサイドシフトシリンダ
11を駆動して、上下左右方向で位置合わせするものに
限定されない。即ち、リーチシリンダ5やティルトシリ
ンダ12を駆動して、前後方向や傾動方向にフォーク6
を自動で位置合わせしてもよい。
In each of the above-described embodiments, the fork automatic position control is not limited to the one in which the lift cylinder 8 and the side shift cylinder 11 are driven to perform position adjustment in the vertical and horizontal directions. That is, the reach cylinder 5 and the tilt cylinder 12 are driven to move the fork 6 in the front-rear direction and the tilting direction.
May be automatically aligned.

【0085】○ 前記各実施形態において、アクチュエ
ータは各種シリンダ5,8,11,12であることに限
定されず、例えばモータ等の他の駆動源を採用してもよ
い。 ○ 前記各実施形態において、産業車両はリーチ型フォ
ークリフトトラック1に限定されず、カウンタバランス
式のフォークリフトでもよい。また、荷役機器もフォー
ク6に限定されず、ロールクランプなどの他のものを採
用してもよい。
In each of the above-described embodiments, the actuator is not limited to the various cylinders 5, 8, 11, and 12, and other drive sources such as a motor may be adopted. In each of the above-mentioned embodiments, the industrial vehicle is not limited to the reach type forklift truck 1 and may be a counterbalance type forklift. Further, the cargo handling equipment is not limited to the fork 6, and other equipment such as a roll clamp may be adopted.

【0086】前記実施形態及び別例から把握できる技術
的思想について、以下にその効果とともに記載する。 (1)請求項1〜8において、前記撮影手段により撮影
された画像データを基に、前記標識を画像認識処理する
画像認識処理手段(80)を備え、前記標識位置検出手
段は、前記画像認識処理の処理結果に基づき、画面座標
上における前記標識の座標位置を算出し、前記移動目標
点算出手段は、前記画像認識処理の処理結果に基づき、
画面座標上における移動目標点の座標位置を算出する。
The technical ideas that can be understood from the above-described embodiment and other examples will be described below along with their effects. (1) In Claims 1-8, the image recognition processing means (80) for performing image recognition processing of the sign based on the image data taken by the image taking means is provided, and the sign position detecting means is provided for the image recognition. Based on the processing result of the processing, calculates the coordinate position of the sign on the screen coordinates, the movement target point calculating means, based on the processing result of the image recognition processing,
The coordinate position of the movement target point on the screen coordinates is calculated.

【0087】(2)請求項1〜8において、前記距離算
出手段は、画面座標上における前記荷役機器と前記標識
との間で、縦座標間距離及び実座標間距離を算出し、複
数の前記標識の一つを前記荷役機器の位置合わせの際の
目印として設定する際の設定条件として、前記縦座標間
距離及び実座標間距離の間で優先順位を設定する優先順
位設定手段を備え、前記目標設定手段は、前記優先順位
設定手段によって設定された優先側の座標間距離で標識
設定を行い、その優先側が同じであれば非優先側の座標
間距離で標識設定処理を行う。この場合、縦座標間距離
と実座標間距離の間で設定された優先順位に基づき、標
識設定処理を実行することができる。
(2) In any one of claims 1 to 8, the distance calculating means calculates a distance between ordinates and a distance between actual coordinates between the cargo handling equipment and the sign on the screen coordinates, and a plurality of the distances are calculated. As a setting condition when setting one of the signs as a mark when aligning the cargo handling equipment, a priority setting means for setting a priority between the ordinate distance and the actual coordinate distance is provided, The target setting means performs the marker setting with the inter-coordinate distance on the priority side set by the priority setting means, and performs the marker setting process with the inter-coordinate distance on the non-priority side if the priorities are the same. In this case, the sign setting process can be executed based on the priority order set between the ordinate distance and the actual coordinate distance.

【0088】[0088]

【発明の効果】以上詳述したように本発明によれば、荷
役機器の位置合わせを自動で行う位置制御機能を備えた
場合に、荷役対象側に設けられた標識が複数存在してい
ても、そのうち一つの標識を荷役機器の位置合わせの際
の目印として設定できる。
As described above in detail, according to the present invention, when a position control function for automatically positioning the cargo handling equipment is provided, even if there are a plurality of markers provided on the cargo handling target side. , One of them can be set as a mark when aligning the cargo handling equipment.

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

【図1】 第1実施形態におけるフォークリフトの斜視
図。
FIG. 1 is a perspective view of a forklift according to a first embodiment.

【図2】 フォークリフトで荷役作業を行うときの模式
側面図。
FIG. 2 is a schematic side view when carrying out cargo handling work with a forklift.

【図3】 マルチレバーの斜視図。FIG. 3 is a perspective view of a multi lever.

【図4】 マルチレバーの側面図。FIG. 4 is a side view of the multi lever.

【図5】 フォーク自動位置制御についての説明図。FIG. 5 is an explanatory diagram of automatic fork position control.

【図6】 表示装置の画面図であり、(a)がフォーク
の位置合わせ前、(b)が位置合わせ後である。
FIG. 6 is a screen view of the display device, in which (a) is before the fork alignment and (b) is after the alignment.

【図7】 荷役操作支援装置の電気的構成図。FIG. 7 is an electrical configuration diagram of the cargo handling operation support device.

【図8】 (a),(c)はマーク、(b),(d)は
テンプレートの正面図。
8A and 8C are marks, and FIGS. 8B and 8D are front views of the template.

【図9】 2箇所マッチングについての説明図。FIG. 9 is an explanatory diagram of two-point matching.

【図10】 (a)は画面上に設定された画面座標系を
示す画面図。(b)は実座標系を示す表示図。
FIG. 10A is a screen diagram showing a screen coordinate system set on the screen. (B) is a display diagram showing an actual coordinate system.

【図11】 カメラ位置を求める際の算出方法を説明す
るための説明。
FIG. 11 is an explanatory diagram for explaining a calculation method when obtaining a camera position.

【図12】 同一模様のマークが表示されたときの表示
装置の画面図。
FIG. 12 is a screen diagram of the display device when marks having the same pattern are displayed.

【図13】 移動目標点を算出する計算式についての説
明図。
FIG. 13 is an explanatory diagram of a calculation formula for calculating a movement target point.

【図14】 第2実施形態における同一模様のマークが
表示されたときの表示装置の画面図。
FIG. 14 is a screen view of the display device when marks of the same pattern are displayed in the second embodiment.

【図15】 別例における同一模様のマークが表示され
たときの表示装置の画面図。
FIG. 15 is a screen view of the display device when a mark having the same pattern is displayed in another example.

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

1…産業車両としてのフォークリフト、5,8,11,
12…アクチュエータを構成する各種シリンダ、6…荷
役機器としてのフォーク、19…撮影手段としてのCC
Dカメラ、25…表示手段としての表示装置、40…画
面、42…移動目標点、47…作業モード設定手段、優
先順位設定手段、制御手段を構成する荷役制御部、60
…作業状態検出手段としての荷重センサ、77…描画手
段としての描画表示部、83…距離算出手段としての二
座標間距離算出部、84…目標設定手段としてのターゲ
ット決定部、85…標識位置検出手段と標識サイズ検出
手段を構成するマーク位置算出部、86…移動目標点算
出手段としての移動目標点算出部、87…シフト量算出
手段を構成する実座標位置算出部、88…シフト量算出
部を構成するずれ量算出部、M1,M2,Ma,Mb…
標識としてのマーク、H…縦座標間距離、R…実座標間
距離、K…横座標間距離。
1 ... Forklift as an industrial vehicle, 5, 8, 11,
12 ... Various cylinders constituting actuator, 6 ... Fork as cargo handling device, 19 ... CC as photographing means
D camera, 25 ... Display device as display means, 40 ... Screen, 42 ... Moving target point, 47 ... Work mode setting means, priority order setting means, cargo handling control section constituting control means, 60
... load sensor as working state detecting means, 77 ... drawing display section as drawing means, 83 ... two-coordinate distance calculating section as distance calculating means, 84 ... target determining section as target setting means, 85 ... sign position detection Means and mark size detecting means, mark position calculating section, 86 ... moving target point calculating section as moving target point calculating means, 87 ... actual coordinate position calculating section forming shift amount calculating means, 88 ... shift amount calculating section , M1, M2, Ma, Mb ...
Marks as markers, H ... ordinate distance, R ... actual coordinate distance, K ... abscissa distance.

フロントページの続き Fターム(参考) 3F333 AA02 AE02 BA02 BA08 BB05 BD02 BE02 CA21 CA24 FA23 FA27 FA36 FD03 FD08 FD12 FE05 FE09 Continued front page    F term (reference) 3F333 AA02 AE02 BA02 BA08 BB05                       BD02 BE02 CA21 CA24 FA23                       FA27 FA36 FD03 FD08 FD12                       FE05 FE09

Claims (9)

【特許請求の範囲】[Claims] 【請求項1】 荷役機器の位置合わせを自動で行う位置
制御機能を備えた産業車両の標識選定装置であって、 前記荷役機器の荷役対象を撮影する撮影手段と、 前記撮影手段により撮影された画像データを基に、前記
荷役機器を自動位置合わせする際の目印となる標識の画
面座標上における位置を検出する標識位置検出手段と、 自動位置合わせを行う際の前記標識のあるべき位置を移
動目標点として、前記撮影手段により撮影された画像デ
ータを基に、前記画面座標上における前記移動目標点の
位置を算出する移動目標点算出手段と、 前記標識位置検出手段及び移動目標点算出手段から求ま
る座標位置を基に、前記標識と前記移動目標点との間の
座標間距離を算出する距離算出手段と、 前記撮影手段により前記標識が複数撮影された場合に、
これら標識のうち前記距離算出手段により求まる2座標
間の座標間距離が最も短い標識を、前記荷役機器の位置
合わせの際の目印として設定する目標設定手段とを備え
た産業車両の標識選定装置。
1. A sign selecting device for an industrial vehicle having a position control function for automatically aligning the cargo handling equipment, the photographing means photographing a cargo handling target of the cargo handling equipment, and the photographing means. Mark position detecting means for detecting the position on the screen coordinates of a mark that serves as a mark for automatically aligning the cargo handling device based on image data, and moving the position where the mark should be when performing automatic alignment As a target point, a moving target point calculating means for calculating the position of the moving target point on the screen coordinates based on the image data photographed by the photographing means, and a marker position detecting means and a moving target point calculating means. Based on the obtained coordinate position, distance calculating means for calculating the inter-coordinate distance between the sign and the movement target point, when a plurality of the signs are photographed by the photographing means,
A marker selecting device for an industrial vehicle, comprising: a marker having the shortest inter-coordinate distance between the two coordinates obtained by the distance calculating means as a marker when aligning the cargo handling equipment.
【請求項2】 前記距離算出手段は、画面座標上におけ
る前記移動目標点と前記標識との間の縦座標間距離を算
出し、前記目標設定手段は、前記移動目標点の座標位置
に対して縦座標で最も近くに位置する標識を、前記荷役
機器の位置合わせの目標として設定する請求項1に記載
の産業車両の標識選定装置。
2. The distance calculation means calculates an inter-ordinate coordinate distance between the movement target point and the marker on screen coordinates, and the target setting means calculates the coordinate position of the movement target point with respect to the coordinate position. The sign selecting device for an industrial vehicle according to claim 1, wherein a sign located closest to the ordinate is set as a target for alignment of the cargo handling equipment.
【請求項3】 前記距離算出手段は、画面座標上におけ
る前記移動目標点と前記標識との間の実座標間距離を算
出し、前記目標設定手段は、前記移動目標点の座標位置
に対して実座標で最も近くに位置する標識を、前記荷役
機器の位置合わせの目標として設定する請求項1に記載
の産業車両の標識選定装置。
3. The distance calculation means calculates an actual inter-coordinate distance between the movement target point and the marker on the screen coordinates, and the target setting means determines the coordinate position of the movement target point. The sign selecting device for an industrial vehicle according to claim 1, wherein a sign located closest in real coordinates is set as a target for alignment of the cargo handling equipment.
【請求項4】 前記撮影手段により撮影された画像デー
タを基に、前記標識の画面座標上におけるサイズを検出
する標識サイズ検出手段を備え、 前記移動目標点算出手段は、前記標識サイズ検出手段か
ら求まる前記標識の画面座標上のサイズと所定の既知の
値とを基に、画面座標上における前記移動目標点の位置
を算出する請求項1〜3のうちいずれか一項に記載の産
業車両の標識選定装置。
4. A marker size detecting means for detecting the size of the marker on the screen coordinates based on the image data photographed by the photographing means, and the movement target point calculating means is provided from the marker size detecting means. The industrial vehicle according to any one of claims 1 to 3, wherein the position of the movement target point on the screen coordinate is calculated based on the size of the sign on the screen coordinate and a predetermined known value. Sign selection device.
【請求項5】 前記撮影手段により撮影された画像を表
示する表示手段と、 前記移動目標点算出手段から求まる移動目標点を、前記
表示手段の画面上に描画として表示する描画手段とを備
え、 前記距離算出手段は、前記表示手段の画面上に表示され
る前記標識と、前記描画手段により表示される前記描画
との間の座標間距離を算出し、前記目標設定手段は、前
記描画の座標位置に対して座標間距離が最も短い標識
を、前記荷役機器の位置合わせの目標として設定する請
求項1〜4のうちいずれか一項に記載の産業車両の標識
選定装置。
5. A display means for displaying the image photographed by the photographing means, and a drawing means for displaying the movement target point obtained by the movement target point calculation means on the screen of the display means as a drawing. The distance calculation means calculates an inter-coordinate distance between the sign displayed on the screen of the display means and the drawing displayed by the drawing means, and the target setting means sets the coordinate of the drawing. The sign selecting device for an industrial vehicle according to any one of claims 1 to 4, wherein a sign having the shortest inter-coordinate distance with respect to a position is set as a target for alignment of the cargo handling equipment.
【請求項6】 前記距離算出手段は、画面座標上におけ
る前記移動目標点と前記標識との間で、縦座標間距離、
実座標間距離及び横座標間距離を算出し、 複数の前記標識の一つを前記荷役機器の位置合わせの際
の目印として設定する際の設定条件として、前記縦座標
間距離、実座標間距離及び横座標間距離の間で優先順位
を設定する優先順位設定手段を備え、 前記目標設定手段は、前記優先順位設定手段によって設
定された優先側の座標間距離で標識設定を行い、その優
先側が同じであれば非優先側の座標間距離で標識設定処
理を行うことを特徴とする請求項1,4,5のうちいず
れか一項に記載の産業車両の標識選定装置。
6. The distance calculation means, between the movement target point on the screen coordinates and the sign, the distance between the ordinates,
The ordinate-to-ordinate coordinate distance and the actual-to-actual coordinate distance are set as the setting conditions for calculating the distance between the real coordinates and the distance between the abscissas and setting one of the plurality of signs as a mark when aligning the cargo handling equipment. And a priority setting means for setting a priority between the distances between the abscissas, the target setting means performs the marker setting at the inter-coordinate distance of the priority side set by the priority setting means, and the priority side is The sign selecting device for an industrial vehicle according to any one of claims 1, 4 and 5, wherein, if they are the same, the sign setting process is performed by the distance between the coordinates on the non-priority side.
【請求項7】 荷役作業の作業状態を検出する作業状態
検出手段と、 前記作業状態検出手段の検出結果を基に、荷役作業の作
業モードを設定する作業モード設定手段とを備え、 前記標識位置検出手段は、複数の前記標識のうち前記作
業モード設定手段により設定された作業モードに基づく
標識を検出する請求項1〜6のうちいずれか一項に記載
の産業車両の標識選定装置。
7. A work state detecting means for detecting a work state of the cargo handling work, and a work mode setting means for setting a work mode of the cargo handling work based on a detection result of the work state detecting means. 7. The sign selecting device for an industrial vehicle according to claim 1, wherein the detecting unit detects a sign based on the work mode set by the work mode setting unit from among the plurality of signs.
【請求項8】 前記荷役機器を動かすために駆動される
少なくとも1つのアクチュエータと、 前記撮影手段により撮影された画像データを基に、実座
標上における前記荷役機器の位置を算出し、目標位置に
対して前記荷役機器の動かすべき距離を算出するシフト
量算出手段と、 前記荷役機器が前記目標位置に位置するように、前記シ
フト量算出手段により算出された距離だけ前記荷役機器
を移動させるべく前記アクチュエータを駆動する制御手
段とを備えた請求項1〜7のうちいずれか一項に記載の
産業車両の標識選定装置。
8. The position of the cargo-handling equipment on actual coordinates is calculated based on at least one actuator driven to move the cargo-handling equipment, and image data taken by the photographing means, and the target position is calculated. On the other hand, a shift amount calculating means for calculating a distance to move the cargo handling equipment, and to move the cargo handling equipment by the distance calculated by the shift amount calculating means so that the cargo handling equipment is located at the target position. The industrial vehicle sign selection device according to any one of claims 1 to 7, further comprising: a control unit that drives an actuator.
【請求項9】 請求項1〜8のうちいずれか一項に記載
の標識選定装置を備えた産業車両。
9. An industrial vehicle equipped with the sign selecting device according to claim 1.
JP2002014739A 2002-01-23 2002-01-23 Industrial vehicle sign selection device and industrial vehicle Expired - Lifetime JP3941521B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2002014739A JP3941521B2 (en) 2002-01-23 2002-01-23 Industrial vehicle sign selection device and industrial vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2002014739A JP3941521B2 (en) 2002-01-23 2002-01-23 Industrial vehicle sign selection device and industrial vehicle

Publications (2)

Publication Number Publication Date
JP2003212493A true JP2003212493A (en) 2003-07-30
JP3941521B2 JP3941521B2 (en) 2007-07-04

Family

ID=27651334

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2002014739A Expired - Lifetime JP3941521B2 (en) 2002-01-23 2002-01-23 Industrial vehicle sign selection device and industrial vehicle

Country Status (1)

Country Link
JP (1) JP3941521B2 (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007084162A (en) * 2005-09-20 2007-04-05 Toyota Industries Corp Cargo handling supporting device of fork lift
WO2023037773A1 (en) * 2021-09-09 2023-03-16 村田機械株式会社 Traveling vehicle system and traveling vehicle

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5899299U (en) * 1981-12-26 1983-07-06 三菱重工業株式会社 Unmanned forklift unloading positioning device
JPS62100994U (en) * 1985-12-17 1987-06-27
US5586620A (en) * 1995-05-12 1996-12-24 Crown Equipment Corporation Remote viewing apparatus for fork lift trucks
JPH1053396A (en) * 1996-08-07 1998-02-24 Komatsu Ltd Unmanned cargo handling method and its cargo handling control device
JPH1129299A (en) * 1997-07-09 1999-02-02 Shinmeiwa Soft Technol Kk Device and method for recognizing vehicle position and article storing device
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 (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS5899299U (en) * 1981-12-26 1983-07-06 三菱重工業株式会社 Unmanned forklift unloading positioning device
JPS62100994U (en) * 1985-12-17 1987-06-27
US5586620A (en) * 1995-05-12 1996-12-24 Crown Equipment Corporation Remote viewing apparatus for fork lift trucks
JPH1053396A (en) * 1996-08-07 1998-02-24 Komatsu Ltd Unmanned cargo handling method and its cargo handling control device
JPH1129299A (en) * 1997-07-09 1999-02-02 Shinmeiwa Soft Technol Kk Device and method for recognizing vehicle position and article storing device
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

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007084162A (en) * 2005-09-20 2007-04-05 Toyota Industries Corp Cargo handling supporting device of fork lift
JP4666154B2 (en) * 2005-09-20 2011-04-06 株式会社豊田自動織機 Cargo handling support device for forklift
WO2023037773A1 (en) * 2021-09-09 2023-03-16 村田機械株式会社 Traveling vehicle system and traveling vehicle

Also Published As

Publication number Publication date
JP3941521B2 (en) 2007-07-04

Similar Documents

Publication Publication Date Title
US20040073359A1 (en) Position control device and position control method of stevedoring apparatus in industrial vehicle
US7219769B2 (en) Industrial vehicle equipped with load handling operation control apparatus
JP3900912B2 (en) Industrial vehicle
EP1361190B1 (en) Camera lifting device and load handling support device of industrial vehicle, and industrial vehicle
JP4882176B2 (en) Cargo handling support notification device and industrial vehicle in industrial vehicle
JP2003028614A (en) Method and apparatus for detection of position, industrial vehicle, mark, pallet, shelf and system for materials handling and pasting agent
WO2020039817A1 (en) Loading operation assistance device for forklift
JP7213428B2 (en) Driving support device for industrial vehicles
JP3900942B2 (en) Automatic position control device for cargo handling equipment in industrial vehicles, industrial vehicle and automatic position control method for cargo handling equipment
JP2019202877A (en) Remote control system for industrial vehicle
JP4961643B2 (en) Cargo handling control device and industrial vehicle in industrial vehicle
JP2003212493A (en) Marker selection device for industrial vehicle and industrial vehicle
JP3858703B2 (en) Cargo work support device for industrial vehicle and industrial vehicle
JP2003155199A (en) Voice annunciator for industrial vehicle and industrial vehicle
JP2003128395A (en) Cargo handling work support device in industrial vehicle and industrial vehicle
JP2003089500A (en) Loading lever and industrial vehicle
JP3900902B2 (en) Cargo work support device for industrial vehicle and industrial vehicle
JP3900887B2 (en) Industrial vehicle work mode switching device and industrial vehicle
WO2020085068A1 (en) Remote control system for forklift
KR102318692B1 (en) Unmanned freight transportation apparatus for multi-stage pallet of atypical support type, and method for operating the same
JP2018178878A (en) Industrial vehicle
WO2020008992A1 (en) Remote operating system for forklift
JP2021042071A (en) Side shift device control device for forklift
WO2022130896A1 (en) Forklift
JP7371544B2 (en) Industrial vehicle work support equipment

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040412

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20060811

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060829

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20061030

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20061205

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20070129

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20070326

R151 Written notification of patent or utility model registration

Ref document number: 3941521

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

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

Free format text: PAYMENT UNTIL: 20100413

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20110413

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20120413

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20130413

Year of fee payment: 6

EXPY Cancellation because of completion of term