JP2003155198A - Loading/unloading assisting device for industrial vehicle and industrial vehicle - Google Patents

Loading/unloading assisting device for industrial vehicle and industrial vehicle

Info

Publication number
JP2003155198A
JP2003155198A JP2001352369A JP2001352369A JP2003155198A JP 2003155198 A JP2003155198 A JP 2003155198A JP 2001352369 A JP2001352369 A JP 2001352369A JP 2001352369 A JP2001352369 A JP 2001352369A JP 2003155198 A JP2003155198 A JP 2003155198A
Authority
JP
Japan
Prior art keywords
cargo handling
cargo
screen
target
mark
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
JP2001352369A
Other languages
Japanese (ja)
Other versions
JP3900902B2 (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 JP2001352369A priority Critical patent/JP3900902B2/en
Priority to US10/470,491 priority patent/US7219769B2/en
Priority to PCT/JP2002/001353 priority patent/WO2003008325A1/en
Priority to EP02712415.5A priority patent/EP1408001B1/en
Publication of JP2003155198A publication Critical patent/JP2003155198A/en
Application granted granted Critical
Publication of JP3900902B2 publication Critical patent/JP3900902B2/en
Anticipated expiration legal-status Critical
Expired - Lifetime legal-status Critical Current

Links

Abstract

PROBLEM TO BE SOLVED: To assist the process of image screen-aided aligning of loading equipment by showing (drawing) positioning data for alignment in an image on a display screen covering the loading equipment operating area (object cargo). SOLUTION: The forklift truck operating area, picked up by a camera provided in a carriage elevated along a mast erected on the forklift truck, is shown on a screen 28A of a display in the operator's seat. Marks M1, M2 on a pallet 41, shelf 42 in the image on the screen 28 are subjected to image recognition, and position data are obtained on marks M1, M2. By using the position data, a target point mark 87 is shown whereto the mark M is to move on the screen 28A for aligning the fork with the object cargo (fig. (a)). That the forklift truck is aligned with the object cargo is confirmed on the screen 28A when the mark M and the target point mark 87 occupy the same spot (fig. (b)).

Description

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

【0001】[0001]

【発明の属する技術分野】本発明は、産業車両に設けら
れた荷役機器の作業エリアを撮影した画像を、運転席な
どに設けられた表示手段の画面を通して見られるように
し、例えばパレットなどの荷役対象に荷役機器を位置合
わせする位置合わせ作業を支援する産業車両における荷
役作業支援装置及び産業車両に関するものである。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention makes it possible to view an image of a work area of a cargo handling equipment provided in an industrial vehicle through a screen of a display means provided in a driver's seat or the like, for example, cargo handling such as a pallet. BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to a cargo handling work support device for an industrial vehicle and an industrial vehicle that support a positioning work for positioning a cargo handling device to a target.

【0002】[0002]

【従来の技術】例えば、この種の産業車両であるフォー
クリフトでは、多段式のマストが車体に備えられ、フォ
ーク等の荷役機器(アタッチメント)を有したキャリッ
ジがマストに沿って昇降可能に設けられている。例えば
棚の高所で荷取作業や荷置作業をする際は、運転者は荷
役レバー(リフトレバー)を操作して多段式マストを油
圧駆動でスライド伸長させることにより、フォーク等の
荷役機器をマストに沿って上昇させ、荷役機器を棚上の
パレットまたは棚面に対し所定の位置関係となるように
位置合わせを行う。この際、運手者は高所(例えば3〜
6メートル)を仰ぎ見ながらフォークがパレットの穴ま
たは棚面の少し上方位置に合ったかどうかを目で確認し
つつ荷役レバーを操作する必要がある。しかし、高所を
下方から仰ぎ見ながらフォークとパレット等が水平方向
に位置合わせされたかを目視で判断することは困難で、
熟練者でもこの位置合わせに時間を要するという問題が
あった。
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 cargo handling lever (lift lever) to hydraulically drive a multi-stage mast to slide and extend it, thereby allowing cargo handling equipment such as forks to be installed. 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. At this time, the driver is in a high place (for example, 3 ~
It is necessary to operate the cargo handling lever while looking up (6 meters) and visually checking whether the fork is aligned with the hole of the pallet or a position slightly above the shelf surface. However, it is difficult to visually determine whether the fork and pallet, etc. are aligned horizontally while looking up at a high place from below.
There is a problem that even a skilled person needs time for this alignment.

【0003】従来、例えば米国特許5586620号に
は、キャリッジにカメラを取り付け、フォーク正面に見
える棚やパレット等の様子を撮影した画像を、運転席に
いる運転者が表示装置の画面を通して見られるようにす
ることで、高所でのフォークの位置合わせ作業を支援す
る装置が知られている。この場合、カメラで撮影された
画像を表示装置の画面を通して見られるので、高所の荷
役作業でも運転者はフォークの位置合せ作業を比較的簡
単かつ正確に行うことができる。
Conventionally, for example, in US Pat. No. 5,586,620, a camera is attached to a carriage, and an image of a shelf or a pallet seen in front of a fork is photographed by a driver in a driver's seat through a screen of a display device. A device for supporting the fork alignment work at a high place is known. In this case, since the image captured by the camera can be viewed through the screen of the display device, the driver can relatively easily and accurately perform the fork alignment work even in the cargo handling work at a high place.

【0004】[0004]

【発明が解決しようとする課題】しかし、高所を見上げ
てフォークを目標とする荷に目視によりおおよそ位置合
わせした後、画面上でフォークを目標とする荷に対し位
置合わせすることになる。しかし、画面上にはその位置
合わせのためにフォークを移動させるべき移動目標とす
べき目印となるものが何もなかったので、何を目標に位
置合わせすればよいか画面上で目標取りがしにくいとい
う問題があった。
However, after looking up at a high place and visually aligning the fork with the target load, the fork is aligned with the target load on the screen. However, there was nothing on the screen that served as a moving target to move the fork for the purpose of alignment, so what was to be aligned with the target was to remove the target on the screen. There was a problem that it was difficult.

【0005】また、カメラで撮影した作業エリアの画像
データを基にパレットや棚部の位置を画像処理によって
割り出し、フォークを目標とするパレットや棚部などの
荷役対象に対して自動で位置合わせする自動制御を採用
することも考えられる。この場合、画面を見てフォーク
が自動で位置合わせされたことの完了を容易に知ること
ができないという問題がある。
Further, the positions of pallets and shelves are indexed by image processing based on the image data of the work area photographed by the camera, and the forks are automatically aligned with the object of cargo handling such as pallets and shelves. It is also possible to adopt automatic control. In this case, there is a problem that it is not possible to easily know the completion of the automatic alignment of the forks by looking at the screen.

【0006】本発明は前記課題を解決するためになされ
たものであって、その目的は、荷役機器の作業エリア
(荷役対象)を映し出す表示手段の画面に表示された画
像上に、荷役機器を位置合わせするための位置決め情報
を表示(描画)することにより、画面を通して荷役機器
を位置合わせするときの助けとすることができる産業車
両における荷役作業支援装置及び産業車両を提供するこ
とにある。
The present invention has been made to solve the above-mentioned problems, and its purpose is to display the cargo handling equipment on the image displayed on the screen of the display means showing the work area (the cargo handling target) of the cargo handling equipment. An object of the present invention is to provide a cargo handling work support device for an industrial vehicle and an industrial vehicle that can be helpful in aligning cargo handling equipment through a screen by displaying (drawing) positioning information for positioning.

【0007】[0007]

【課題を解決するための手段】上記目的を達成するため
に請求項1に記載の発明では、荷役対象に位置合わせす
るために車体に移動可能に設けられた荷役機器と、表示
手段と、荷役対象の位置を検出する検出手段と、前記検
出手段により検出された位置検出結果を基に前記荷役機
器を前記荷役対象に位置決めする手助けとなる位置決め
情報を前記表示手段に表示する表示制御手段とを備えた
ことを要旨とする。
In order to achieve the above object, in the invention according to claim 1, a cargo handling device movably provided on a vehicle body for aligning with a cargo handling target, a display means, and a cargo handling A detection means for detecting the position of the target, and a display control means for displaying on the display means positioning information that helps to position the cargo handling equipment on the cargo handling target based on the position detection result detected by the detection means. The point is to have prepared.

【0008】この発明によれば、検出手段により荷役対
象の位置が検出される。検出手段により検出された位置
検出結果を基に荷役機器を荷役対象に位置決めする手助
けとなる位置決め情報が表示制御手段によって表示手段
に表示される、請求項2に記載の発明では、荷役作業を
するために車体に移動可能に設けられた荷役機器と、前
記荷役機器による作業の対象となる荷役対象を撮影する
撮影手段と、前記撮影手段により撮影された画像を画面
に表示する表示手段と、前記撮影手段の撮影エリア内に
おける前記荷役対象の位置を検出する検出手段と、前記
検出手段により検出された位置データを基に、前記荷役
機器を荷役対象に位置合わせするときの位置決め情報を
演算する演算手段と、前記表示手段の画面に前記荷役機
器を荷役対象に位置決めする際の位置決め情報を描画す
る描画制御手段とを備えたことを要旨とする。
According to the present invention, the position of the cargo handling target is detected by the detecting means. The invention according to claim 2, wherein the display control means displays positioning information for assisting in positioning the cargo handling equipment on the cargo handling target based on the position detection result detected by the detection means. For this purpose, a cargo handling device movably provided on the vehicle body, a photographing means for photographing a cargo handling target to be a work target of the cargo handling equipment, a display means for displaying an image photographed by the photographing means on a screen, Detecting means for detecting the position of the cargo handling target in the photographing area of the photographing means, and calculation for calculating positioning information when aligning the cargo handling equipment with the cargo handling target based on the position data detected by the detecting means. Means, and drawing control means for drawing the positioning information when positioning the cargo handling equipment to the cargo handling target on the screen of the display means .

【0009】この発明によれば、検出手段によって、撮
影手段の撮影エリア内における前記荷役対象の位置が検
出される。演算手段によって、この位置データを基に荷
役機器を荷役対象に対し位置合わせするときの位置決め
情報が演算される。そして、描画制御手段により表示手
段の画面に荷役機器を荷役対象に位置決めする際の位置
決め情報が描画される。
According to this invention, the position of the cargo handling target in the photographing area of the photographing means is detected by the detecting means. The computing means computes positioning information when aligning the cargo handling equipment with the cargo handling target based on the position data. Then, the drawing control means draws on the screen of the display means positioning information for positioning the cargo handling equipment on the cargo handling target.

【0010】請求項3に記載の発明では、荷役作業をす
るために車体に移動可能に設けられた荷役機器と、前記
荷役機器による作業の対象となる荷役対象を撮影する撮
影手段と、前記撮影手段により撮影された画像を画面に
表示する表示手段と、前記撮影手段により撮影された画
像データを画像処理することによって前記画面上におけ
る前記荷役対象の位置を検出する検出手段と、前記検出
手段により検出された位置データを基に、前記荷役機器
を荷役対象に位置合わせするときの前記表示手段の画面
上における移動目標点を位置演算する演算手段と、前記
画面の画像上に前記移動目標点の位置を報知するための
位置決め情報を描画する描画制御手段とを備えたことを
要旨とする。
According to a third aspect of the present invention, a cargo handling device movably provided on the vehicle body for carrying out cargo handling work, a photographing means for photographing a cargo handling target to be a work target of the cargo handling device, and the photographing. Display means for displaying an image photographed by the means on the screen; detection means for detecting the position of the cargo handling target on the screen by image-processing the image data photographed by the photographing means; and the detecting means. Based on the detected position data, the calculating means for calculating the position of the movement target point on the screen of the display means when aligning the cargo handling equipment with the cargo handling target, and the movement target point on the image of the screen. The gist of the present invention is to include drawing control means for drawing the positioning information for notifying the position.

【0011】この発明によれば、検出手段によって、撮
影手段により撮影された画像データを画像処理すること
によって画面上における荷役対象の位置が検出される。
演算手段によって、荷役機器を荷役対象に対し位置合わ
せするときの表示手段の画面上における移動目標点が位
置演算される。そして、描画制御手段により画面の画像
上には、移動目標点の位置を報知するための位置決め情
報が描画される。
According to the present invention, the position of the cargo handling object on the screen is detected by the image processing of the image data photographed by the photographing means by the detecting means.
The calculation means calculates the position of the movement target point on the screen of the display means when the cargo handling equipment is aligned with the cargo handling target. Then, the drawing control means draws the positioning information for notifying the position of the movement target point on the image on the screen.

【0012】請求項4に記載の発明では、請求項1〜3
のいずれか一項に記載の発明において、前記位置決め情
報は、前記荷役機器と荷役対象との位置関係の情報であ
ることを要旨とする。
In the invention described in claim 4, claims 1 to 3 are provided.
In the invention described in any one of 1, the gist is that the positioning information is information on a positional relationship between the cargo handling equipment and a cargo handling target.

【0013】この発明によれば、表示手段には荷役機器
と荷役対象との位置関係の情報が表示される。請求項5
に記載の発明では、請求項1〜4のいずれか一項に記載
の発明において、前記表示手段に表示される前記位置決
め情報は、前記荷役機器と荷役対象との位置関係を方向
及び量で示す文字情報であることを要旨とする。
According to the present invention, information on the positional relationship between the cargo handling equipment and the cargo handling target is displayed on the display means. Claim 5
In the invention according to claim 1, in the invention according to any one of claims 1 to 4, the positioning information displayed on the display means indicates a positional relationship between the cargo handling equipment and a cargo handling target in a direction and an amount. The gist is that it is character information.

【0014】この発明によれば、表示手段には、荷役機
器と荷役対象との位置関係を方向及び量で示す文字情報
が表示される。上記目的を達成するために請求項6に記
載の発明では、荷役作業をするために荷役機器が車体に
移動可能に設けられている。撮影手段は前記荷役機器に
よる作業の対象となる荷役対象を撮影する。表示手段は
前記撮影手段により撮影された画像を画面に表示する。
検出手段は、前記撮影手段により撮影された画像データ
を基に前記画面上における前記荷役対象の位置を検出す
る。演算手段は、前記検出手段により検出された位置デ
ータを基に、前記荷役機器を荷役対象に位置合わせする
ときの前記表示手段の画面上における移動目標点を位置
演算する。描画制御手段は、前記画面の画像上に前記移
動目標点の位置を視認させるための目印を描画する。
According to the present invention, the display means displays the character information indicating the positional relationship between the cargo handling equipment and the cargo handling target in terms of direction and quantity. In order to achieve the above object, in the invention according to claim 6, a cargo handling device is provided movably on the vehicle body for carrying out cargo handling work. The photographing means photographs a cargo handling target which is a target of work by the cargo handling equipment. The display means displays the image photographed by the photographing means on the screen.
The detection means detects the position of the cargo handling target on the screen based on the image data photographed by the photographing means. The calculation means calculates the position of the movement target point on the screen of the display means when the cargo handling equipment is aligned with the cargo handling target based on the position data detected by the detection means. The drawing control means draws a mark for visually recognizing the position of the movement target point on the image of the screen.

【0015】この発明によれば、検出手段によって、撮
影手段により撮影された画像データを基に画面上におけ
る荷役対象の位置が検出される。演算手段によって、荷
役機器を荷役対象に対し位置合わせするときの表示手段
の画面上における移動目標点が位置演算される。そし
て、描画制御手段により画面の画像上には、移動目標点
の位置を視認させるための目印が描画される。従って、
画面上に描画された目印から荷役機器を荷役対象に位置
合わせするときの移動目標点を画面を通して視認するこ
とが可能となる。
According to the present invention, the position of the cargo handling target on the screen is detected by the detecting means based on the image data photographed by the photographing means. The calculation means calculates the position of the movement target point on the screen of the display means when the cargo handling equipment is aligned with the cargo handling target. Then, the drawing control means draws a mark for visually recognizing the position of the movement target point on the image on the screen. Therefore,
From the mark drawn on the screen, it becomes possible to visually recognize the movement target point when aligning the cargo handling equipment with the cargo handling target through the screen.

【0016】請求項7に記載の発明では、請求項2〜6
のいずれか一項に記載の発明において、前記検出手段
は、前記撮影手段により撮影された画像データを基に前
記画面上における前記荷役対象の位置を割り出すための
画像認識処理を行う画像認識手段であることを要旨とす
る。
In the invention described in claim 7, claims 2 to 6 are provided.
In the invention according to any one of the items 1 to 3, the detection unit is an image recognition unit that performs an image recognition process for determining the position of the cargo handling target on the screen based on the image data photographed by the photographing unit. The point is that there is.

【0017】この発明によれば、請求項2〜6のいずれ
か一項に記載の発明に以下の作用が加わる。撮影手段に
より撮影された画像データを基に画面上における荷役対
象の位置を割り出すための画像認識処理が画像認識手段
により行われることで、画面上における荷役対象の位置
が割り出される。従って、表示手段の画面に荷役機器の
作業エリア(荷役対象)を映し出すために用いられる撮
影手段の画像データを利用して荷役対象の位置の割り出
し処理が行われる。
According to this invention, the following actions are added to the invention described in any one of claims 2 to 6. The image recognition processing for determining the position of the cargo handling target on the screen based on the image data photographed by the photographing means is performed by the image recognition means, whereby the position of the cargo handling target on the screen is determined. Therefore, the processing for determining the position of the cargo handling target is performed by using the image data of the photographing means used for displaying the work area (the cargo handling target) of the cargo handling equipment on the screen of the display means.

【0018】前記目的を達成するために請求項8に記載
の発明では、荷役機器が荷役作業をするために車体に移
動可能に設けられている。撮影手段は前記荷役機器によ
る作業の対象となる荷役対象を撮影する。表示手段は、
前記撮影手段により撮影された画像を画面に表示する。
演算手段は、前記表示手段の画面上における前記荷役対
象に付されたマークの前記荷役機器を前記荷役対象に位
置合わせするときの移動目標点を位置演算する。描画制
御手段は、前記画面の画像上に前記移動目標点を視認さ
せるための目印を描画する。
In order to achieve the above object, in the invention according to claim 8, the cargo handling equipment is provided movably on the vehicle body for carrying out cargo handling work. The photographing means photographs a cargo handling target which is a target of work by the cargo handling equipment. The display means
The image photographed by the photographing means is displayed on the screen.
The calculating means calculates the position of the movement target point when aligning the cargo handling device with the mark attached to the cargo handling target on the screen of the display means with the cargo handling target. The drawing control means draws a mark for visually recognizing the movement target point on the image of the screen.

【0019】この発明によれば、前記表示手段の画面上
における前記荷役対象に付されたマークの移動目標点を
視認させるための目印が、表示手段の画面の画像上に描
画される。従って、例えば画面上のマークが目印と一致
するように荷役機器を移動させることにより荷役機器の
荷役対象に対する位置合わせを行うことができる。また
荷役機器が自動で位置合わせされるときには安心感が得
られるとともに、マークが目印で示された移動目標点に
一致(許容範囲内での一致も含む)したことをもって、
位置合わせ制御の完了を知ることもできる。
According to the present invention, the mark for visually recognizing the moving target point of the mark attached to the cargo handling object on the screen of the display means is drawn on the image of the screen of the display means. Therefore, for example, by moving the cargo handling equipment so that the mark on the screen matches the mark, the cargo handling equipment can be aligned with the cargo handling target. In addition, you can feel a sense of security when the cargo handling equipment is automatically aligned, and the mark matches the movement target point indicated by the mark (including matching within the allowable range).
It is also possible to know the completion of the alignment control.

【0020】請求項9に記載の発明では、請求項2〜8
のいずれか一項に記載の発明において、産業車両には、
前記荷役機器を移動させる手動操作をするための手動操
作手段と、前記手動操作手段の手動操作に応じて前記荷
役機器を移動させる駆動手段を駆動制御する制御手段と
が備えられている。前記演算手段は、前記手動操作手段
の手動操作によって前記荷役機器を移動させるときの前
記表示手段の画面上における移動目標点を演算する。
In the invention described in claim 9, claims 2 to 8
In the invention described in any one of 1,
A manual operation means for performing a manual operation for moving the cargo handling equipment and a control means for driving and controlling a driving means for moving the cargo handling equipment according to a manual operation of the manual operation means are provided. The calculation means calculates a movement target point on the screen of the display means when the cargo handling equipment is moved by manual operation of the manual operation means.

【0021】この発明によれば、請求項2〜8のいずれ
か一項に記載の発明に以下の作用が加わる。荷役機器を
手動操作手段の手動操作により移動させる際、表示手段
の画面上には荷役機器を荷役対象に位置合わせするとき
の移動目標点を示す目印が画像上に描画される。従っ
て、例えば高揚高における荷役機器の位置合わせを画面
上に映し出された画像を見ながら行うときに、画面の画
像上に描画された目印を目標にして画面上の荷役対象が
動くように手動操作手段を手動操作して荷役機器を移動
させればよい。よって、画面を見ながら荷役機器を荷役
対象に位置合わせする作業がし易くなる。
According to the present invention, the following actions are added to the invention according to any one of claims 2 to 8. When the cargo handling equipment is moved manually by the manual operation means, a mark indicating a movement target point when the cargo handling equipment is aligned with the cargo handling target is drawn on the screen of the display means. Therefore, for example, when aligning the cargo handling equipment at high lift while looking at the image displayed on the screen, a manual operation is performed so that the cargo handling target on the screen moves with the mark drawn on the screen image as the target. The cargo handling equipment may be moved by manually operating the means. Therefore, it becomes easy to perform the work of aligning the cargo handling device with the cargo handling target while looking at the screen.

【0022】請求項10に記載の発明では、請求項2〜
9のいずれか一項に記載の発明において、前記撮影手段
を構成するカメラは前記荷役機器に対し昇降可能に設け
られている。判別手段は、前記荷役機器による荷役作業
が荷取作業か荷置作業であるかを判別する。昇降駆動手
段は、前記判別手段により判別された荷役作業の種別に
応じた高さに前記カメラを前記荷役機器に対し移動配置
するよう駆動される。荷置作業時の前記カメラの配置位
置は前記荷役機器に取られた荷によって作業エリア(荷
役対象)の撮影が妨げられない位置に設定されている。
According to the invention described in claim 10,
In the invention described in any one of 9 above, a camera constituting the photographing means is provided so as to be able to move up and down with respect to the cargo handling equipment. The determining means determines whether the cargo handling work by the cargo handling equipment is a unloading work or a unloading work. The elevating drive means is driven so as to move and arrange the camera with respect to the cargo handling equipment at a height according to the type of the cargo handling work determined by the determination means. The placement position of the camera during the loading operation is set to a position where the load on the loading device does not hinder the imaging of the work area (target of loading).

【0023】この発明によれば、請求項2〜9のいずれ
か一項に記載の発明に以下の作用が加わる。荷役作業の
種別(荷取作業・荷置作業)に応じて荷役機器に対する
カメラの配置位置が異なる。荷が荷役機器に取られた状
態で行われる荷置作業時は、カメラは荷役機器に取られ
た荷によって作業エリア(荷役対象)の撮影が妨げられ
ない位置(高さ)に移動配置される。例えば、荷取作業
時にほぼ正面から荷役対象(作業エリア)を撮影できる
ようにカメラを位置設定し、荷置作業時には荷役機器に
取られた荷によって荷役対象の撮影が遮られないように
カメラを配置することが可能になるので、カメラにより
なるべく荷役機器の位置合わせに適切な位置から撮影す
ることが可能となる。
According to the present invention, the following actions are added to the invention according to any one of claims 2 to 9. The position of the camera with respect to the cargo handling equipment differs depending on the type of cargo handling work (pickup work / loading work). During the loading work that is performed while the load is taken by the cargo handling equipment, the camera is moved to a position (height) where the shooting of the work area (target of cargo handling) is not hindered by the load taken by the cargo handling equipment. . For example, position the camera so that you can shoot the cargo handling object (work area) almost from the front during the loading operation, and set the camera so that the cargo taken by the cargo handling equipment does not block the shooting of the cargo handling object during the loading operation. Since it can be arranged, it is possible to take an image from a position suitable for the alignment of the cargo handling equipment by the camera as much as possible.

【0024】請求項11に記載の発明では、請求項2〜
10のいずれか一項に記載の発明において、前記撮影手
段を構成するカメラは、前記荷役機器を有するキャリッ
ジが昇降可能に設けられたマストの構成部材に対し固定
されている。荷役装置は、前記荷役機器が所定揚高以上
の揚高を昇降するときに該荷役機器と前記カメラとが少
なくとも高さ方向に一定の位置関係を保ったまま前記キ
ャリッジは前記マスト上を移動するように構成されてい
る。前記荷役機器の揚高を検出する揚高検出手段が備え
られている。前記描画制御手段は、前記揚高検出手段に
より検出された揚高が前記所定揚高以上のときに、前記
演算手段により演算された移動目標点の位置データを基
に前記画面の画像上に前記移動目標点を視認させるため
の目印を描画する処理を実行する。
In the invention described in claim 11, claims 2 to
In the invention described in any one of 10 above, the camera constituting the photographing means is fixed to a component member of a mast in which a carriage having the cargo handling device is provided so as to be able to move up and down. In the cargo handling apparatus, the carriage moves on the mast while the cargo handling equipment and the camera maintain a constant positional relationship at least in the height direction when the cargo handling equipment moves up and down at a lift higher than a predetermined lift. Is configured. Lifting height detection means for detecting the lifting height of the cargo handling equipment is provided. When the lift detected by the lift detecting means is equal to or higher than the predetermined lift, the drawing control means displays the image on the screen based on the position data of the moving target point calculated by the calculating means. A process for drawing a mark for visually recognizing the movement target point is executed.

【0025】この発明によれば、請求項2〜10のいず
れか一項に記載の発明に以下の作用が加わる。マストの
構成部材に固定されたカメラは、荷役機器が所定揚高以
上の揚高を昇降するとき、荷役機器に対し少なくとも高
さ方向に一定の位置関係を保つことになる。従って、所
定揚高以上の揚高ではカメラによって荷役機器の作業エ
リア(荷役対象)を荷役機器に対し常に同じ撮影位置か
ら撮影できることになる。よって、カメラをマストの構
成部材に固定する簡単なカメラ取付構造を採用でき、こ
の際、画面の画像上に描画される目印によって荷役機器
を荷役対象に位置合わせするときの移動目標点を視認で
きる。
According to this invention, the following actions are added to the invention described in any one of claims 2 to 10. The camera fixed to the component member of the mast maintains a constant positional relationship at least in the height direction with respect to the cargo handling equipment when the cargo handling equipment moves up and down at a predetermined lift or higher. Therefore, when the lift is higher than the predetermined lift, the camera can always photograph the work area of the cargo handling device (the cargo handling target) from the same photographing position with respect to the cargo handling device. Therefore, a simple camera mounting structure for fixing the camera to the component member of the mast can be adopted, and at this time, the moving target point when aligning the cargo handling equipment with the cargo handling target can be visually recognized by the mark drawn on the screen image. .

【0026】請求項12に記載の発明では、産業車両に
は荷役機器を有するキャリッジが車体に設けられたマス
トに沿って昇降可能に設けられている。前記荷役機器の
作業エリアを撮影可能にカメラは前記マストの構成部材
に設けられている。表示手段は、前記カメラにより撮影
された画像を画面に表示する。判別手段は、荷役機器に
より行われる荷役作業が荷取作業か荷置作業であるかを
判別する。検出手段は、前記判別手段により判別された
荷役作業の種別に応じて荷役対象を決定し、前記カメラ
により撮影された画像データを基に、当該荷役対象の位
置検出用の被画像認識対象を画像認識処理することによ
り前記表示手段の画面上における該荷役対象の位置を検
出する。演算手段は、前記荷役機器を前記荷役対象に位
置合わせするときの前記表示手段の画面上における移動
目標点を位置演算する。描画制御手段は、前記表示手段
の画面上における前記移動目標点を視認させる目印を該
画面の画像上に描画する。
According to the twelfth aspect of the present invention, the carriage having the cargo handling equipment is provided on the industrial vehicle so as to be able to move up and down along the mast provided on the vehicle body. A camera is provided on a component of the mast so that the camera can photograph the work area of the cargo handling equipment. The display means displays an image captured by the camera on the screen. The determination means determines whether the cargo handling work performed by the cargo handling equipment is a unloading work or a unloading work. The detection means determines the cargo handling target according to the type of cargo handling work determined by the determination means, and based on the image data captured by the camera, an image of the target image recognition target for position detection of the cargo handling target is imaged. By performing recognition processing, the position of the cargo handling target on the screen of the display means is detected. The calculation means calculates the position of the movement target point on the screen of the display means when the cargo handling device is aligned with the cargo handling target. The drawing control means draws a mark for visually recognizing the movement target point on the screen of the display means on the image of the screen.

【0027】この発明によれば、カメラがマストの構成
部材に固定される簡単な取付構造であるため、カメラの
取付構造に比較的コストをかけず、表示手段の画の画像
面上に移動目標点を示す目印を描画することが可能にな
る。従って、例えば荷役機器を荷役対象に対し手動操作
で位置合わせするタイプの産業車両において、コストを
あまりかけず荷役機器を荷役対象に位置合わせする際の
移動目標点の目印を画面上に描画でき、その目印により
画面上における移動目標点の位置を簡単に視認させるこ
とが可能となる。
According to the present invention, since the camera has a simple mounting structure in which it is fixed to the constituent members of the mast, the camera mounting structure is relatively inexpensive, and the moving target is moved to the image plane of the image of the display means. It becomes possible to draw a mark indicating a point. Therefore, for example, in an industrial vehicle of a type in which the cargo handling equipment is manually aligned with the cargo handling target, a mark of a movement target point when aligning the cargo handling equipment with the cargo handling target can be drawn on the screen without much cost, The mark makes it possible to easily visually recognize the position of the movement target point on the screen.

【0028】請求項13に記載の発明は、請求項1〜1
3のいずれか一項に記載の発明において、前記検出手段
は、荷取作業と荷置作業を区別して荷役対象を位置検出
し、前記表示手段には前記検出手段により検出された荷
役対象の荷取作業か荷置作業に応じた位置決め情報が表
示される。
The invention described in claim 13 is the invention according to claims 1 to 1.
In the invention according to any one of 3 above, the detection means detects the position of the cargo handling target by distinguishing between the loading operation and the loading work, and the display means detects the cargo handling target detected by the detecting means. Positioning information corresponding to the picking work or the loading work is displayed.

【0029】この発明によれば、請求項1〜13のいず
れか一項に記載の発明の作用に加え、検出手段により、
荷取作業と荷置作業を区別して荷役対象が位置検出さ
れ、表示手段には検出手段により位置検出された荷役対
象の荷取作業か荷置作業に応じた位置決め情報が表示さ
れる。
According to this invention, in addition to the function of the invention described in any one of claims 1 to 13,
The position of the cargo handling target is detected by distinguishing between the cargo picking work and the loading work, and the display means displays the positioning information corresponding to the cargo picking work or the loading work of the cargo handling target whose position is detected by the detecting means.

【0030】請求項14に記載の発明は、産業車両は、
請求項1〜13のいずれか一項に記載の荷役作業支援装
置を備えている。この発明によれば、請求項1〜13の
いずれか一項に記載の荷役作業支援装置を備えているこ
とから、請求項1〜13のいずれか一項に記載の発明と
同様の作用が得られる。
According to the invention of claim 14, the industrial vehicle is
The cargo handling work support device according to any one of claims 1 to 13 is provided. According to this invention, since the cargo handling work support apparatus according to any one of claims 1 to 13 is provided, the same operation as the invention according to any one of claims 1 to 13 can be obtained. To be

【0031】[0031]

【発明の実施の形態】(第1の実施形態)以下、本発明
をフォークリフトの位置検出装置に具体化した第1の実
施形態を図面に従って説明する。
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS (First Embodiment) A first embodiment in which the present invention is embodied in a forklift position detection device will be described below with reference to the drawings.

【0032】図1に示すように、産業車両としてのリー
チ型フォークリフトトラック(以下、フォークリフトと
いう)1は、荷役機器としてのフォーク2を用いて荷役
作業を行う。車体3の前部から前方へ延出する左右一対
のリーチレグ4の先端部に左右の前輪(従動輪)5がそ
れぞれ取付けられており、後輪である駆動操舵輪6は、
車体3に配備されたバッテリ7を電源とする走行用モー
タ8の動力により走行駆動される。運転者は車体3の後
部右側に設けられた立席タイプの運転席9に立った状態
で、ハンドル10を操作して駆動操舵輪6を操舵するこ
とによりフォークリフト1を運転する。
As shown in FIG. 1, a reach type forklift truck (hereinafter referred to as a forklift) 1 as an industrial vehicle uses a fork 2 as a cargo handling device to carry out cargo handling work. Left and right front wheels (driven wheels) 5 are attached to the front ends of a pair of left and right reach legs 4 extending forward from the front of the vehicle body 3, and the drive steered wheels 6 as rear wheels are
The vehicle is driven by the power of a traveling motor 8 that uses a battery 7 provided in the vehicle body 3 as a power source. The driver operates the forklift 1 by operating the steering wheel 10 to steer the driving steered wheels 6 while standing on the standing seat type driver's seat 9 provided on the rear right side of the vehicle body 3.

【0033】車体3の前側に配備された荷役装置(マス
ト装置)11は、リーチシリンダ12の駆動により左右
のリーチレグ4に沿って前後方向に移動(リーチ動作)
可能に設けられている。荷役装置11は、多段式(本例
では3段式)マスト13と、荷役用のキャリッジ14
と、中央のリフトシリンダ15Aと、左右一対のリフト
シリンダ15B(片側のみ図示)とを備えている。マス
ト13はアウタマスト13A、ミドルマスト13Bおよ
びインナマスト13Cからなる3段マストである。本実
施形態の荷役装置11は、キャリッジ14がインナマス
ト13Cの最上位置に一旦到達後はじめてマスト13の
スライド伸長が開始されるテレスコピック型(フルフリ
ー型)である。すなわち、リフトシリンダ15Aはイン
ナマスト13Cの底板に立設されており、リフトシリン
ダ15Aが駆動することによりキャリッジ14は、イン
ナマスト13Cに沿って昇降する。リフトシリンダ15
Bはアウタマスト13Aの背面に立設され、キャリッジ
14がインナマスト13Cの最上端に位置することが検
知された状態で駆動され、その駆動により3段マスト1
3A,13B,13Cがスライド伸縮する。フォーク2
は例えば最高約6メートルまで上昇する。
The cargo handling device (mast device) 11 arranged on the front side of the vehicle body 3 is moved in the front-rear direction along the left and right reach legs 4 by the drive of the reach cylinder 12 (reach operation).
It is possible. The cargo handling device 11 includes a multi-stage (three-stage in this example) mast 13 and a carriage 14 for cargo handling.
And a central lift cylinder 15A and a pair of left and right lift cylinders 15B (only one side is shown). The mast 13 is a three-stage mast including an outer mast 13A, a middle mast 13B, and an inner mast 13C. The cargo handling device 11 of the present embodiment is a telescopic type (full free type) in which the slide extension of the mast 13 is started only after the carriage 14 once reaches the uppermost position of the inner mast 13C. That is, the lift cylinder 15A is erected on the bottom plate of the inner mast 13C, and the carriage 14 moves up and down along the inner mast 13C when the lift cylinder 15A is driven. Lift cylinder 15
B is erected on the back surface of the outer mast 13A and is driven in a state where the carriage 14 is detected to be located at the uppermost end of the inner mast 13C.
3A, 13B and 13C slide and expand and contract. Fork 2
Can rise up to about 6 meters, for example.

【0034】フォークリフト1には、高所(高揚高範
囲)におけるフォーク2の位置合わせ操作を支援する荷
役操作支援装置(フォーク位置決め操作支援装置)20
が設けられている。荷役操作支援装置20は、キャリッ
ジ14を構成するサイドシフタ16の前面中央部に縦長
に延びた状態に組付けられたカメラ昇降装置21を備え
る。カメラ昇降装置21は、キャリッジ14の前面中央
部に組付けられたハウジング22に収納されその下方か
ら出没するように昇降する昇降式のカメラユニット23
を備えている。カメラユニット23は、ハウジング22
内に格納される格納位置と、ハウジング22の下端から
突出する下降位置との間を昇降する。カメラユニット2
3はその下端部に撮影手段としてのカメラ(例えばCC
Dカメラ)24を内蔵し、撮影部(レンズ部)24Aか
らフォーク前方の荷役作業エリアの撮影が可能となって
いる。また格納位置からでも、ハウジング22の前面下
部に形成された撮影窓22Aを通してフォーク前方の荷
役作業エリアをカメラ24によって撮影可能となってい
る。つまり、カメラ24は格納位置と下降位置の二位置
からフォーク前方の荷役作業エリアを撮影可能である。
サイドシフタ16は、マスト13に昇降可能に組付けら
れたリフトブラケット(図示せず)に対し左右方向に移
動可能な状態に組付けられており、サイドシフト時はフ
ォーク2とともにカメラ昇降装置21も一緒に左右にシ
フトする。
The forklift 1 includes a cargo handling operation support device (fork positioning operation support device) 20 for supporting the position alignment operation of the fork 2 in a high place (high lift range).
Is provided. The cargo handling operation support device 20 includes a camera elevating device 21 which is assembled in a vertically elongated state at the center of the front surface of the side shifter 16 which constitutes the carriage 14. The camera raising / lowering device 21 is a raising / lowering camera unit 23 that is housed in a housing 22 attached to the center of the front surface of the carriage 14 and that is raised and lowered so as to project and retract from below.
Is equipped with. The camera unit 23 has a housing 22.
It moves up and down between a storage position stored inside and a lowered position protruding from the lower end of the housing 22. Camera unit 2
3 is a camera (for example, CC
A D camera) 24 is built in, and it is possible to take a picture of the cargo handling work area in front of the fork from the photographing section (lens section) 24A. Further, even from the storage position, the cargo handling work area in front of the fork can be photographed by the camera 24 through the photographing window 22A formed in the lower front surface of the housing 22. That is, the camera 24 can photograph the cargo handling work area in front of the fork from two positions, the storage position and the lowered position.
The side shifter 16 is attached to a lift bracket (not shown) that is attached to the mast 13 so as to be able to move up and down so as to be movable in the left-right direction. Shift left and right.

【0035】また、ルーフ27には運転席9に立つ運転
者からよく見える位置に表示手段としての表示装置(液
晶ディスプレイ装置(LCD))28が取り付けられて
いる。表示装置28の画面には、荷役作業時にカメラ2
4によって撮影されたフォーク前方の画像が映し出され
るようになっている。
Further, a display device (liquid crystal display device (LCD)) 28 as a display means is attached to the roof 27 at a position where a driver standing on the driver's seat 9 can easily see it. The screen of the display device 28 shows the camera 2 during the cargo handling work.
The image of the front of the fork captured by No. 4 is displayed.

【0036】また、インストルメントパネル上には、図
2に示す操作レバー(マルチレバー)31が設けられて
いる。操作レバー31は、これ1つで走行操作と荷役操
作の全ての操作を可能とするもので複数種類の操作部を
備えている。
An operating lever (multi-lever) 31 shown in FIG. 2 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.

【0037】操作レバー31は、インストルメントパネ
ル上の所定箇所に形成されたスロット32に沿って前後
方向に傾動するレバー本体33を備えている。レバー本
体33は操作しない状態ではパネル面に対し略垂直とな
る中立位置にバネ(図示せず)の付勢力により復帰す
る。レバー本体33の上端部にはグリップ34が車幅方
向に対し30度〜60度程度の角度をもって傾斜する姿
勢に取付けられている。グリップ34の左端部には、略
円筒形のノブ35が軸線Cを中心に回転可能に設けられ
ている。またグリップ34の左部分前縁にシーソースイ
ッチ36が、グリップ34の左部分背面に十字スイッチ
37が、グリップ34の左部分前面に作動スイッチ38
がそれぞれ設けられている。グリップ34は、運転者が
右肘を付いて右手で握る状態で使用される。グリップ3
4を握った状態では、親指でノブ35と十字スイッチ3
7を操作でき、人差し指でシーソースイッチ36を操作
でき、中指で作動スイッチ38を操作できる。なお、同
図における円内がA方向から見た十字スイッチ37であ
る。
The operation lever 31 is provided with a lever body 33 that tilts in the front-rear direction along a slot 32 formed at a predetermined position on the instrument panel. When the lever body 33 is not operated, it is returned to a neutral position substantially perpendicular to the panel surface 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. At the left end of the grip 34, a substantially cylindrical knob 35 is provided rotatably around the axis C. A seesaw switch 36 is provided on the front edge of the left portion of the grip 34, a cross switch 37 is provided on the rear surface of the left portion of the grip 34, and an operation switch 38 is provided on the front surface of the left portion of the grip 34.
Are provided respectively. The grip 34 is used in a state where the driver holds the right elbow and holds it with the right hand. Grip 3
While holding 4, hold the knob 35 and cross switch 3 with your thumb.
7, the seesaw switch 36 can be operated with the index finger, and the operation switch 38 can be operated with the middle finger. In addition, the inside of the circle in the figure is the cross switch 37 viewed from the direction A.

【0038】グリップ34を握った右手でレバー本体3
3を前方に傾けるとフォークリフト1が前進し、レバー
本体33を後方に傾けるとフォークリフト1が後進す
る。ノブ35に形成された突起35Aを親指で上方へ押
してノブ35を上側に回すとフォーク2が上昇し、親指
で突起35Aを下方へ押してノブ35を下側に回すとフ
ォーク2が下降する。また、人差し指でシーソースイッ
チ36の前端を押すと荷役装置11が前方に移動し、人
差し指でシーソースイッチ36の後端を押すと荷役装置
11が後方に移動する。十字スイッチ37は上下・左右
の4方向に操作可能になっており、上下方向の操作でマ
スト13のティルトを操作し、左右方向の操作でサイド
シフトを操作する。親指で十字スイッチ37の上端部を
押すとマスト13が前傾し、十字スイッチ37の下端部
を押すとマスト13が後傾する。また親指で十字スイッ
チ37の右端部を押すとフォーク2が右方向に移動し、
十字スイッチ37の左端部を押すとフォーク2が左方向
に移動する。
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 protrusion 35A formed on the knob 35 is pushed upward with the thumb and the knob 35 is turned upward, the fork 2 is raised, and when the protrusion 35A is pushed downward with the thumb and the knob 35 is turned downward, the fork 2 is lowered. Further, when the front end of the seesaw switch 36 is pushed with the index finger, the cargo handling device 11 moves forward, and when the rear end of the seesaw switch 36 is pushed with the index finger, the cargo handling device 11 moves backward. The cross switch 37 can be operated in four directions of up / down / left / right, and the tilt of the mast 13 is operated by the up / down operation, and the side shift is operated by the left / right operation. Pushing the upper end of the cross switch 37 with the thumb tilts the mast 13 forward, and pushing the lower end of the cross switch 37 tilts the mast 13 backward. If you press the right end of the cross switch 37 with your thumb, the fork 2 will move to the right,
When the left end of the cross switch 37 is pressed, the fork 2 moves leftward.

【0039】図3に示すように、本実施形態では、荷役
対象である棚40とパレット41には、フォーク2を棚
40またはパレット41に対して位置合わせする際の位
置目標とするマークM1,M2が付されている。すなわ
ち、パレット41の正面と背面には2つの差込穴41A
間中央部にパレット位置検出用のマークM1が付されて
いる。一方、棚40の棚部(ビーム)42にはその正面
中央部に棚位置検出用のマークM2が付されている。こ
こで、パレット41に付されたマークM1と、棚部42
に付されたマークM2は互いに白黒が反転した模様の図
形となっている。カメラ24により撮影されたマークM
1(またはM2)の画面上の位置からフォーク2と荷役
対象(パレット41または棚部42)の左右(Y方向)
・上下(Z方向)のずれ量を算出し、そのずれ量を無く
すようにフォーク2を荷役対象に自動で位置合わせする
フォーク自動位置合わせ制御が行われる。
As shown in FIG. 3, in this embodiment, the marks M1, which are position targets when the forks 2 are aligned with the shelves 40 or the pallet 41, on the shelves 40 and the pallets 41 which are the objects of cargo handling. M2 is attached. That is, two insertion holes 41A are provided on the front and back of the pallet 41.
A pallet position detection mark M1 is provided at the center of the space. On the other hand, the shelf portion (beam) 42 of the shelf 40 is provided with a shelf position detecting mark M2 at the center of the front surface thereof. Here, the mark M1 attached to the pallet 41 and the shelf 42
The mark M2 attached to is a figure having a pattern in which black and white are mutually inverted. Mark M taken by camera 24
Left and right (Y direction) of the fork 2 and the cargo object (pallet 41 or shelf 42) from the position of 1 (or M2) on the screen
-Fork automatic alignment control is performed to calculate the amount of vertical (Z direction) displacement and to automatically align the fork 2 with the cargo handling target so as to eliminate the amount of displacement.

【0040】次に、荷役操作支援装置20の電気的構成
を図4に基づいて説明する。荷役操作支援装置20はコ
ントローラ45を備える。コントローラ45は、画像制
御部46、荷役制御部47、駆動回路48,49および
ソレノイド駆動回路50を備えている。
Next, the electrical configuration of the cargo handling operation support device 20 will be described with reference to FIG. The cargo handling operation support device 20 includes 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.

【0041】画像制御部46にはその入力側にカメラ2
4が電気的に接続され、映像信号(画像信号)が入力さ
れるとともに、その出力側には表示装置28およびスピ
ーカ51が接続されている。画像制御部46は、カメラ
24からの映像信号(画像信号)を基に表示装置28の
画面に撮影画像を表示させる。また画像制御部46は、
撮影画像中からマークを画像認識する画像認識処理(テ
ンプレートマッチング処理)をし、この画像認識によっ
て把握される画面上(画面座標系)におけるマークの位
置から荷役対象の位置を把握する。そして荷役対象を捉
えられる位置にフォーク2を位置合わせする際の目標と
なる目標移動点(目標目印)を画面上に表示させる表示
処理を行う。この表示処理では、目標移動点を案内する
方法として、表示装置28の画面に目標マークを表示さ
せる方法を採用する。この表示処理については後で詳述
する。またスピーカ51からは荷役作業支援状況や作業
者への指示内容などが音声ガイドで知らせられる。
The image control unit 46 has a camera 2 on its input side.
4 is electrically connected, a video signal (image signal) is input, and the display device 28 and the speaker 51 are connected to the output side. The image control unit 46 displays a captured image on the screen of the display device 28 based on the video signal (image signal) from the camera 24. Further, the image control unit 46
Image recognition processing (template matching processing) is performed to recognize the mark from the captured image, and the position of the cargo handling target is grasped from the position of the mark on the screen (screen coordinate system) grasped by this image recognition. Then, display processing is performed to display a target moving point (target mark), which is a target when the fork 2 is aligned to a position where the cargo handling target can be captured, on the screen. In this display processing, a method of displaying a target mark on the screen of the display device 28 is adopted as a method of guiding the target moving point. This display process will be described in detail later. Further, the speaker 51 informs the cargo handling work support status and the contents of instructions to the worker by a voice guide.

【0042】一方、荷役制御部47には、上限位置検知
スイッチ52、下限位置検知スイッチ53、マルチレバ
ー31の各ポテンショメータ54,55およびスイッチ
36〜38、さらに揚高検出手段としての揚高センサ5
8、荷重センサ59、ティルト角センサ60などが接続
されている。また荷役制御部47には、駆動回路48,
49を介して昇降駆動手段としての電動アクチュエータ
61および荷役モータ(電動モータ)62がそれぞれ接
続されるとともに、ソレノイド駆動回路50を介してオ
イルコントロールバルブ64に組付けられた各種電磁比
例弁65〜69のソレノイドが接続されている。なお、
荷役制御部47および荷重センサ59により判別手段が
構成される。
On the other hand, in the cargo handling control unit 47, the upper limit position detection switch 52, the lower limit position detection switch 53, the potentiometers 54 and 55 of the multi-lever 31, the switches 36 to 38, and the lift sensor 5 as lift detection means.
8, a load sensor 59, a tilt angle sensor 60, etc. are connected. Further, the cargo handling control unit 47 includes a drive circuit 48,
An electric actuator 61 as a lifting drive means and a cargo handling motor (electric motor) 62 are respectively connected via 49, and various solenoid proportional valves 65 to 69 assembled to an oil control valve 64 via a solenoid drive circuit 50. The solenoid of is connected. In addition,
The cargo handling control unit 47 and the load sensor 59 constitute a discriminating means.

【0043】荷役制御部47は、各ポテンショメータ5
4,55、スイッチ36,37からの信号を基に電磁比
例弁65〜69の電流値制御と荷役モータ62の駆動制
御を行う。荷役モータ62の作動により荷役ポンプ(油
圧ポンプ)70が駆動されることでオイルコントロール
バルブ65に作動油が供給される。マルチレバー31の
操作信号を基にその操作に対応する各電磁比例弁65〜
69が比例制御されることにより、リフトシリンダ15
A,15B、リーチシリンダ12、サイドシフトシリン
ダ71、ティルトシリンダ72が油圧制御され、フォー
ク2の昇降操作、リーチ操作、サイドシフト操作、ティ
ルト操作が可能となっている。なお、シリンダ15A,
15B,71により駆動手段が構成される。
The cargo handling control unit 47 controls the potentiometers 5
4, 55 and the switches 36 and 37, the current value control of the solenoid proportional valves 65 to 69 and the drive control of the cargo handling motor 62 are performed. By operating the cargo handling motor 62, the cargo handling pump (hydraulic pump) 70 is driven to supply hydraulic oil to the oil control valve 65. Based on the operation signal of the multi-lever 31, each solenoid proportional valve 65 to 5 corresponding to the operation.
69 is proportionally controlled to lift cylinder 15
A, 15B, the reach cylinder 12, the side shift cylinder 71, and the tilt cylinder 72 are hydraulically controlled, and the lifting operation, the reach operation, the side shift operation, and the tilt operation of the fork 2 are possible. In addition, the cylinder 15A,
A drive means is constituted by 15B and 71.

【0044】荷役制御部47は、マルチレバー操作時の
荷役制御の他、カメラユニット23の昇降制御と、フォ
ーク自動位置合わせ制御とを司る。フォーク自動位置合
わせ制御は、フォーク2を一定高さ以上に上昇させて行
われる高所の荷役作業を支援するためのもので、揚高セ
ンサ58により検出されたフォーク2の揚高が設定揚高
(例えば約2メートル)以上にあるときに限り行われ
る。荷役制御部47は荷重センサ59の検出値を基にフ
ォーク2上の荷の有無を判断して荷役モードを判別し、
フォーク2上に荷が無く荷重検出値が閾値以下となる
「荷取りモード」では、カメラユニット23を格納位置
に配置し、フォーク2上に荷が有って荷重検出値が閾値
を超える「荷置きモード」では、カメラユニット23を
下降位置に配置する。カメラユニット23の昇降のため
駆動された電動アクチュエータ61は、カメラユニット
23が上限位置に達して上限位置検知スイッチ52がオ
ンしたときと、カメラユニット23が下限位置に達して
下限位置検知スイッチ53がオンしたときに駆動停止さ
れる。
The cargo handling control section 47 controls the cargo handling when the multi-lever is operated, as well as the raising / lowering control of the camera unit 23 and the automatic fork alignment control. The fork automatic alignment control is for supporting the cargo handling work at a high place performed by raising the fork 2 to a certain height or more, and the lift of the fork 2 detected by the lift sensor 58 is set to the set lift. Only when it is above (for example, about 2 meters) or more. The cargo handling control unit 47 determines whether there is a load on the fork 2 based on the detection value of the load sensor 59 to determine the cargo handling mode,
In the “unloading mode” in which there is no load on the fork 2 and the load detection value is less than or equal to the threshold value, the camera unit 23 is placed in the storage position, and there is a load on the fork 2 and the load detection value exceeds the threshold value. In the "place mode", the camera unit 23 is arranged in the lowered position. The electric actuator 61 driven to raise and lower the camera unit 23 operates when the camera unit 23 reaches the upper limit position and the upper limit position detection switch 52 turns on, and when the camera unit 23 reaches the lower limit position and the lower limit position detection switch 53 operates. Driving is stopped when it is turned on.

【0045】画像制御部46は、表示処理部75、画像
処理部76、描画表示部77、描画データ記憶部78お
よび音声合成部79を備える。表示処理部75は、カメ
ラ24により撮影された画像が画面に映し出されるよう
にカメラ24から入力した映像信号を表示装置28に出
力する。また音声合成部79は、音声アナウンス(音声
ガイド)などのための音声合成処理を行ってスピーカ5
1に音声信号を出力する。また表示処理部75からの画
像データが画像処理部76に入力される。なお、描画表
示部77および描画データ記憶部78により描画制御手
段が構成される。
The image control unit 46 includes a display processing unit 75, an image processing unit 76, a drawing display unit 77, 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 24 to the display device 28 so that the image captured by the camera 24 is displayed on the screen. Further, the voice synthesizing unit 79 performs a voice synthesizing process for a voice announcement (voice guide) or the like to perform the speaker 5 operation.
The audio signal is output to 1. The image data from the display processing unit 75 is also input to the image processing unit 76. The drawing display unit 77 and the drawing data storage unit 78 constitute drawing control means.

【0046】画像処理部76は、画面上のマークM1,
M2の位置を割り出す画像認識処理と、その割り出した
マーク位置を基に車両(フォーク2)と荷役対象との位
置関係を演算する。画像処理部76は、画像認識処理部
81、テンプレート記憶部82、画像演算部83および
演算手段としての表示位置決定部84を備えている。画
像認識処理部81はパターンマッチング処理による画像
認識処理を行う。画像演算部83は、車両と荷役対象と
の車幅方向のずれ量が許容範囲を超える場合にそのずれ
量を無くすために必要な車両の幅寄せ方向および幅寄せ
距離を算出する。表示位置決定部84は、幅寄せ方向お
よび幅寄せ距離を指示する表示を画面上のどの位置に表
示させるべきかその表示位置を決定する。なお、画像処
理部76は、マイクロコンピュータ(マイコン)および
メモリ(ROM)等に格納されたプログラムデータによ
って構成される。また描画表示部77および描画データ
記憶部78は、描画制御用ゲートアレイと描画用VRA
Mにより構成される。また、画像認識処理部81、テン
プレート記憶部82および画像演算部83によって、検
出手段および画像認識手段が構成される。
The image processing unit 76 displays the mark M1, on the screen.
An image recognition process for calculating the position of M2 and a positional relationship between the vehicle (fork 2) and the cargo handling target are calculated based on the calculated mark position. The image processing unit 76 includes an image recognition processing unit 81, a template storage unit 82, an image calculation unit 83, and a display position determination unit 84 as calculation means. The image recognition processing unit 81 performs image recognition processing by pattern matching processing. When the deviation amount between the vehicle and the cargo-handling target in the vehicle width direction exceeds the allowable range, the image calculation unit 83 calculates the vehicle lateral movement direction and the lateral movement distance required to eliminate the deviation amount. The display position determination unit 84 determines the display position at which position on the screen the display indicating the width-shifting direction and the width-shifting distance should be displayed. The image processing unit 76 is composed of program data stored in a microcomputer, a memory (ROM), or the like. The drawing display unit 77 and the drawing data storage unit 78 include a drawing control gate array and a drawing VRA.
It is composed of M. Further, the image recognition processing unit 81, the template storage unit 82, and the image calculation unit 83 constitute a detection unit and an image recognition unit.

【0047】図5は、マークとテンプレートを示す。同
図(a)はパレット位置検出用のマークM1を示し、同
図(c)は棚位置検出用のマークM2を示す。また同図
(b)がマークM1用のテンプレートT1、同図(d)
がマークM2用のテンプレートT2である。
FIG. 5 shows marks and templates. The figure (a) shows the mark M1 for pallet position detection, and the figure (c) shows the mark M2 for shelf position detection. Further, FIG. 7B is a template T1 for the mark M1, and FIG.
Is a template T2 for the mark M2.

【0048】マークM1はパターンP1,P1を2個並
べて構成され、マークM2はパターンP2,P2を2個
並べて構成されている。マークとは全体の模様、パター
ンとはマークを構成する2つの模様を指す。パターンマ
ッチング処理に使うテンプレートT1,T2は、パター
ンP1,P2と同じ模様を有する。2つのマークM1,
M2の各パターンP1,P2は、互いに白と黒が反転し
た模様となっている。
The mark M1 is formed by arranging two patterns P1 and P1. The mark M2 is formed by arranging two patterns P2 and P2. The mark refers to the entire pattern, and the pattern refers to the two patterns that make up the mark. The templates T1 and T2 used for the pattern matching process have the same pattern as the patterns P1 and P2. Two marks M1,
Each of the patterns P1 and P2 of M2 has a pattern in which white and black are reversed.

【0049】各パターンP1,P2は、一点を中心とし
て放射状に真っ直ぐ延びる複数本の境界線によって白と
黒に色分けされた模様である。本実施形態の各パターン
P1,P2は、正方形の2本の対角線により区画された
4つの領域を白と黒で色分けした模様である。但し、テ
ンプレートの四角形の辺に相当する外形線は模様の一部
ではない。マークとカメラの距離の違いに応じて画面2
8A上に映し出されるマークM1,M2の大きさが変化
しても、その撮影されたパターンP1,P2の中心部分
には常にテンプレートT1,T2と同サイズのパターン
が存在するので、1つのテンプレートT1,T2を用い
ただけのパターンマッチング処理によりマークM1,M
2を認識できるようになっている。テンプレートT1,
T1は、カメラ24から所定距離以内で撮影されたマー
クM1,M2は全て認識可能となるような所定サイズ
(前記所定距離離れた撮影時のマークサイズと同サイズ
以下のサイズ)に設定してある。
Each of the patterns P1 and P2 has 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 a center. Each of the patterns P1 and P2 of the present embodiment is a pattern in which four areas 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. Screen 2 depending on the distance between the mark and the camera
Even if the sizes of the marks M1 and M2 displayed on the 8A change, a pattern of the same size as the templates T1 and T2 always exists in the center portion of the photographed patterns P1 and P2, so that one template T1 , M2, T2 by pattern matching process
2 can be recognized. Template T1,
T1 is set to a predetermined size (size equal to or smaller than the mark size at the time of shooting at the predetermined distance) such that all marks M1 and M2 shot within a predetermined distance from the camera 24 can be recognized. .

【0050】図4に示すテンプレート記憶部82には、
2つのテンプレートT1,T2のデータが記憶されてい
る。画像認識処理部81は、荷役制御部47から通知さ
れた荷役モードが「荷取モード」であればテンプレート
T1を使用し、「荷置モード」であればテンプレートT
2を使用する。つまり荷取モードであればパレット位置
検出用のマークM1を認識するパターンマッチング処理
が行われ、荷置モードであれば棚位置検出用のマークM
2を認識するパターンマッチング処理が行われる。
The template storage section 82 shown in FIG.
Data of two templates T1 and T2 are stored. The image recognition processing unit 81 uses the template T1 if the cargo handling mode notified from the cargo handling control unit 47 is the "unloading mode", and the template T1 if it is the "loading mode".
Use 2. That is, the pattern matching process for recognizing the pallet position detection mark M1 is performed in the loading mode, and the shelf position detection mark M is performed in the loading mode.
A pattern matching process for recognizing 2 is performed.

【0051】図6(a)は画面上に設定された画面座標
系を示す。画面座標系では座標を画素の単位で取り扱
い、同図(a)における画面28Aでは、横方向画素数
H、縦方向画素数Vとなっている。ここではマークM2
を例にして説明する。画像認識処理部81は、同図
(b)に示すように、画像データ上のマークM2を構成
する2つのパターンP2,P2に対しテンプレートT2
により2箇所でマッチングし、各パターンP2,P2を
認識する。画像演算部83は、画像認識処理部81が認
識した2つのパターンP2,P2の各中心点(放射中心
点)の座標(I1 ,J1 ),(I2 ,J2 )をそれぞれ
算出し、これら2つの座標値を基にマークM2の重心
(I,J)とパターンP2,P2の中心間距離Dを求め
る。なお、マークM1についてもI,J,D値の求め方
は同様である。
FIG. 6A shows a screen coordinate system set on the screen. In the screen coordinate system, the coordinates are handled in units of pixels, and in the screen 28A in FIG. 7A, the horizontal pixel number is H and the vertical pixel number is V. Here is the mark M2
Will be described as an example. As shown in FIG. 2B, the image recognition processing unit 81 uses the template T2 for the two patterns P2 and P2 forming the mark M2 on the image data.
Thus, the patterns P2 and P2 are recognized by matching at two points. The image calculation unit 83 calculates the coordinates (I1, J1) and (I2, J2) of the center points (radiation center points) of the two patterns P2 and P2 recognized by the image recognition processing unit 81, respectively, and calculates these two values. Based on the coordinate values, the center of gravity (I, J) of the mark M2 and the center distance D of the patterns P2 and P2 are obtained. The method for obtaining the I, J, and D values for the mark M1 is the same.

【0052】図7は、実座標系を示す。実座標系は同図
のようにマークMの中心(重心)を原点Oとし、マーク
Mに垂直な方向でカメラ24と逆の向きにX軸、X軸を
水平面内で反時計回りに90度回転した方向にY軸、鉛
直方向(上方向)にZ軸をとる3次元座標を想定してい
る。そしてこの実座標系でカメラ24の相対座標(相対
位置)(Xc,Yc,Zc)を求め、この相対座標を基
にフォーク2の位置ずれ量を算出する。図6に示す画面
座標系において計算したデータI,J,Dを使用し、幾
何変換を行って実座標系の相対座標(Xc,Yc,Z
c)は計算される。
FIG. 7 shows a real coordinate system. In the real coordinate system, the center (center of gravity) of the mark M is set to the origin O as shown in FIG. It is assumed that the three-dimensional coordinates have the Y axis in the rotated direction and the Z axis in the vertical direction (upward direction). Then, the relative coordinate (relative position) (Xc, Yc, Zc) of the camera 24 is obtained in this real coordinate system, and the position shift amount of the fork 2 is calculated based on this relative coordinate. Using the data I, J, and D calculated in the screen coordinate system shown in FIG. 6, geometric transformation is performed and relative coordinates (Xc, Yc, Z) in the real coordinate system are used.
c) is calculated.

【0053】以下、I,J,D値からカメラ24の実座
標系における相対座標(Xc ,Yc,Zc )を求める計
算方法について説明する。図8は、実座標系でカメラと
マークを上から見た図を示す。また図9は、実座標系と
画面座標系について相似関係にあることを示す。同図左
側がカメラ24に撮影された実座標系のYZ平面を示す
もので、同図右側がカメラ24に撮影された画像の画面
座標系におけるIJ平面を示す。像の歪みを考慮しなけ
れば、これらの2つの像は相似関係にある。
A method of calculating relative coordinates (Xc, Yc, Zc) in the actual coordinate system of the camera 24 from the I, J, D values will be described below. FIG. 8 shows a view from above of the camera and marks in the real coordinate system. Further, FIG. 9 shows that the real coordinate system and the screen coordinate system have a similar relationship. The left side of the figure shows the YZ plane of the real coordinate system photographed by the camera 24, and the right side of the figure shows the IJ plane in the screen coordinate system of the image photographed by the camera 24. If the image distortion is not taken into consideration, these two images are in a similar relationship.

【0054】図8,図9に示すように、実座標系におい
て撮影範囲の横幅は、2L・tan αで示され、これは画
面座標系では画面28Aの横方向画素数Hとなる。ここ
で、角度「α」は、図8に示すようにカメラ24の水平
画角の2分の1である。またLは、カメラ24とYZ平
面との間の距離であり、|Xc |に等しい(L=|Xc
|)。また、実座標系におけるマークM内の2つのパタ
ーンP,Pの中心間距離dは、画面座標系では中心間距
離Dとなる。つまり実座標系と画面座標系の相似比は、
d:Dとなる。また、原点Oから像の中心までの横座標
については、実座標系のYc と、画面座標系のI−H/
2とが対応関係にある。また原点Oから像の中心までの
縦座標については、実座標系のZc と、画面座標系のJ
−V/2とが対応関係にある。
As shown in FIGS. 8 and 9, the horizontal width of the photographing range in the real coordinate system is represented by 2L · tan α, which is the horizontal pixel number H of the screen 28A in the screen coordinate system. Here, the angle “α” is one half of the horizontal angle of view of the camera 24 as shown in FIG. L is the distance between the camera 24 and the YZ plane and is equal to | Xc | (L = | Xc
|). Further, the center-to-center distance d between the two patterns P and P in the mark M in the real coordinate system is the center-to-center distance D in the screen coordinate system. In other words, the similarity ratio between the real coordinate system and the screen coordinate system is
d: It becomes D. Regarding the abscissa from the origin O to the center of the image, Yc of the real coordinate system and I-H / of the screen coordinate system are used.
There is a correspondence relationship with 2. Regarding the ordinate from the origin O to the center of the image, Zc in the real coordinate system and J in the screen coordinate system.
-V / 2 has a correspondence relationship.

【0055】画面座標系の座標(I,J)と距離Dの値
を用いて、図9の相似関係を用いた幾何変換を行えば、
図7に示す実座標系(XYZ座標系)におけるカメラ2
4の相対座標(Xc,Yc,Zc)は、次式より算出さ
れる。 Xc =−L=−Hd/(2Dtan α) … (1) Yc =d/D(I−H/2) … (2) Zc =d/D(J−V/2) … (3) ここで、H,V,α,d値は既知の値であるため、I,
J,D値を算出すれば、座標(Xc,Yc,Zc)が求
まる。
By using the coordinates (I, J) of the screen coordinate system and the value of the distance D, geometric transformation using the similarity relationship of FIG. 9 is performed.
The camera 2 in the real coordinate system (XYZ coordinate system) shown in FIG.
The relative coordinates (Xc, Yc, Zc) of 4 are calculated by the following equation. Xc = -L = -Hd / (2Dtan α) (1) Yc = d / D (I-H / 2) (2) Zc = d / D (J-V / 2) (3) where , H, V, α, d values are known values, so I,
The coordinates (Xc, Yc, Zc) can be obtained by calculating the J and D values.

【0056】荷役制御部47には、相対座標算出部85
および制御量算出部86が備えられている。相対座標算
出部85は、画像制御部46から荷役制御部47へ送ら
れたデータI,J,Dを基に、実座標系におけるカメラ
24の相対座標OC(Xc,Yc,Zc )を算出する。制御
量算出部86は、この実座標系で求めたカメラ24の相
対座標(相対位置)(Xc,Yc,Zc)を基に、フォ
ーク2を荷役対象に位置合わせする際のフォーク2と目
標位置との位置ずれ量を演算する。すなわち、フォーク
2を荷役対象に位置決めするときに必要なX、Y、Z方
向の移動距離を計算する。
The cargo handling control unit 47 includes a relative coordinate calculation unit 85.
Also, a control amount calculation unit 86 is provided. The relative coordinate calculation unit 85 calculates the relative coordinate OC (Xc, Yc, Zc) of the camera 24 in the actual coordinate system based on the data I, J, D sent from the image control unit 46 to the cargo handling control unit 47. . The control amount calculation unit 86, based on the relative coordinates (relative position) (Xc, Yc, Zc) of the camera 24 obtained in this real coordinate system, the fork 2 and the target position when aligning the fork 2 with the cargo handling target. Calculate the amount of positional deviation between and. That is, the moving distances in the X, Y, and Z directions required when positioning the fork 2 on the cargo handling target are calculated.

【0057】図11は、画像認識処理からフォーク自動
位置合わせ制御までの制御処理の流れを説明するもので
ある。まず画像データを取得すると、画像認識処理部8
1がテンプレート記憶部82からテンプレートTを読み
出してパターンマッチング処理を行う。画像演算部83
は、画像認識処理部81で認識されたパターンの位置を
基にマークMの重心座標(I,J)とパターン中心間距
離Dを画面座標系(画素レベル)で算出する。ここで算
出されたデータI,J,Dは、表示位置決定部84に送
られる。表示位置決定部84は、データI,J,Dを基
に、フォーク2を荷役対象(パレット41または棚部4
2)に位置合わせするときの画面28A(画面座標系)
におけるマークMの移動目標点の座標を演算する。
FIG. 11 illustrates the flow of control processing from image recognition processing to fork automatic alignment control. First, when the image data is acquired, the image recognition processing unit 8
1 reads the template T from the template storage unit 82 and performs pattern matching processing. Image calculation unit 83
Calculates the barycentric coordinates (I, J) of the mark M and the pattern center distance D on the screen coordinate system (pixel level) based on the position of the pattern recognized by the image recognition processing unit 81. The data I, J, D calculated here are sent to the display position determination unit 84. The display position determination unit 84 uses the data I, J, and D to load the fork 2 as a cargo target (the pallet 41 or the shelf 4).
Screen 28A (screen coordinate system) when aligning with 2)
The coordinates of the movement target point of the mark M at are calculated.

【0058】ここで、図10に示すように、カメラ位置
C、フォーク位置F、パレット位置P、マーク重心位置
(原点)Oとおき、荷取作業時に、フォーク位置Fをパ
レット位置Pに位置合わせするときのベクトルFPを考
えると、ベクトルFP=ベクトルOP−ベクトルOC−
ベクトルCFの関係にある。ここで、点Cと点F、点O
と点Pはそれぞれ同一鉛直線上の位置にとるものとす
る。ベクトルCF,OPは、それぞれカメラ位置Cとフ
ォーク位置Fとの距離、マーク重心位置Oとパレット位
置Pとの距離に相当し、共に既知情報である。
Here, as shown in FIG. 10, the camera position C, the fork position F, the pallet position P, and the mark center of gravity position (origin) O are set so that the fork position F is aligned with the pallet position P during the loading operation. Considering the vector FP when doing, vector FP = vector OP−vector OC−
There is a relationship of vector CF. Here, point C, point F, and point O
And the point P are located 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.

【0059】この既知情報についてベクトルOPの成分
(Xp,Yp,Zp)、ベクトルCFの成分(Xcf,Y
cf,Zcf)とそれぞれおくと、フォーク2をパレット4
1に位置合わせするために画面28A上でマークM1を
移動させるべき移動目標点の座標(It,Jt)は、次
式により与えられる。 It=H/2+(Yp−Ycf)*D/d … (4) Jt=V/2+(Zp−Zcf)*D/d … (5) ここで、Yp,Zp、Ycf、Zcfは、既知の値である。
Regarding this known information, the components of the vector OP (Xp, Yp, Zp) and the components of the vector CF (Xcf, Y)
cf and Zcf) respectively, fork 2 and pallet 4
The coordinates (It, Jt) of the movement target point on which the mark M1 is to be moved on the screen 28A in order to align with 1 are given by the following equation. It = H / 2 + (Yp-Ycf) * D / d (4) Jt = V / 2 + (Zp-Zcf) * D / d (5) Here, Yp, Zp, Ycf, and Zcf are known. It is a value.

【0060】同様に、荷置作業時を考えると、フォーク
2を棚部42に対し位置合わせする棚面42Aから所定
距離(10〜20cm)上方位置を荷置位置Rとおく
と、ベクトルCF,ORが既知情報となる。ベクトルO
Rは、マーク重心位置Oと荷置位置Rとの距離に相当す
る。この既知情報についてベクトルORの成分(Xr,
Yr,Zr)、ベクトルCFの成分(Xcf,Ycf,Zc
f)とそれぞれおくと、フォーク2を荷置位置Rに位置
合わせするために画面28A上でマークM2を移動させ
るべき移動目標点の座標(It,Jt)は、次式により
与えられる。 It=H/2+(Yr−Ycf)*D/d … (6) Jt=V/2+(Zr−Zcf)*D/d … (7) ここで、Yr,Zr、Ycf、Zcfは、既知の値である。
上記(4) 〜(7) の各式の求め方については後述する。表
示位置決定部84で算出された移動目標点の座標(I
t,Jt)は、描画表示部77に送られ、画面28Aの
画像上における移動目標点の位置に図13に示す移動目
標点マーク87を描画する描画処理が行われる。移動目
標点マーク87は、4つの三角形が頂点を中心を向けて
等角度間隔に配置された図形からなり、各4頂点で囲ま
れた中心点が移動目標点を指し示す。
Similarly, considering the loading operation, if the loading position R is a position above the shelf surface 42A for aligning the fork 2 with the shelf 42 by a predetermined distance (10 to 20 cm), the vector CF, OR becomes known information. Vector O
R corresponds to the distance between the mark center of gravity position O and the loading position R. The components (Xr,
Yr, Zr), vector CF components (Xcf, Ycf, Zc
f) respectively, the coordinates (It, Jt) of the movement target point to move the mark M2 on the screen 28A for aligning the fork 2 with the loading position R are given by the following equation. It = H / 2 + (Yr-Ycf) * D / d (6) Jt = V / 2 + (Zr-Zcf) * D / d (7) Here, Yr, Zr, Ycf, and Zcf are known. It is a value.
How to obtain each of the equations (4) to (7) will be described later. The coordinates of the movement target point calculated by the display position determination unit 84 (I
t, Jt) is sent to the drawing display unit 77, and a drawing process for drawing the moving target point mark 87 shown in FIG. 13 at the position of the moving target point on the image of the screen 28A is performed. The movement target point mark 87 is composed of figures 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 indicates the movement target point.

【0061】またデータI,J,Dは荷役制御部47へ
送られる。相対座標算出部85は、データI,J,Dを
基に、実座標系におけるカメラ24の相対座標OC(X
c,Yc,Zc )を算出する。制御量算出部86は、カメラ
24の相対座標(Xc,Yc,Zc)を基に、既知情報
(ベクトルCF,OP)を用いてフォーク2を荷役対象
に位置合わせする際のフォーク2と目標位置との位置ず
れ量(ベクトルFPの各成分)を演算する。すなわち、
フォーク2を荷役対象に位置決めするときに必要なX、
Y、Z方向の移動距離を計算する。
Further, the data I, J, D are sent to the cargo handling control unit 47. The relative coordinate calculation unit 85 uses the data I, J, and D to calculate the relative coordinate OC (X
c, Yc, Zc) is calculated. The control amount calculation unit 86 uses the known information (vectors CF and OP) based on the relative coordinates (Xc, Yc, Zc) of the camera 24 and the fork 2 and the target position when aligning the fork 2 with the cargo handling target. The amount of positional deviation between (and each component of the vector FP) is calculated. That is,
X required for positioning the fork 2 on the cargo handling target,
The moving distance in the Y and Z directions is calculated.

【0062】ベクトルFPは次式で表される。 ベクトルFP=−ベクトルCF−ベクトルOC+ベクト
ルOP よって、荷取作業時の位置ずれ量(Xfp、Yfp,Zfp)
は、 (Xfp、Yfp,Zfp)=(Xcf−Xc+Xp,Ycf−Yc
+Yp,Zcf−Zc+Zp) 荷置作業時の位置ずれ量(Xfr、Yfr,Zfr)は、 (Xfr、Yfr,Zfr)=(Xcf−Xc+Xr,Ycf−Yc
+Yr,Zcf−Zc+Zr) となる。
The vector FP is expressed by the following equation. Vector FP = -Vector CF-Vector OC + Vector OP Therefore, the amount of positional deviation during the pickup operation (Xfp, Yfp, Zfp)
Is (Xfp, Yfp, Zfp) = (Xcf-Xc + Xp, Ycf-Yc
+ Yp, Zcf-Zc + Zp) The amount of displacement (Xfr, Yfr, Zfr) during the loading operation is (Xfr, Yfr, Zfr) = (Xcf-Xc + Xr, Ycf-Yc
+ Yr, Zcf-Zc + Zr).

【0063】この位置ずれ量のデータは画像制御部46
に送られ、描画表示部77は、位置ずれ量のデータであ
るX,Y,Z方向の各距離の数値を示すテキストデータ
を、描画データ記憶部78から読み出して、画面28A
の上段の文字情報表示領域に図13に示すように描画す
る。この結果、フォーク2を荷役対象に位置合わせする
ために必要なフォーク2のX,Y,Z方向の各移動距離
が描画される。ここで「距離」は荷役対象までの距離
(前後方向の移動距離)、「横」は左右方向の移動距離
(右方向を正)、「高さ」は上下方向の移動距離(上方
向を正)を示す。
The data of this positional deviation amount is used as the image control unit 46.
The drawing display unit 77 reads the text data indicating the numerical values of the respective distances in the X, Y, and Z directions, which is the data of the positional deviation amount, from the drawing data storage unit 78, and displays it on the screen 28A.
Drawing is performed in the upper character information display area as shown in FIG. As a result, the respective movement distances in the X, Y, and Z directions of the fork 2 necessary for aligning the fork 2 with the cargo handling target are drawn. Here, "distance" is the distance to the cargo handling target (moving distance in the front-back direction), "sideways" is the moving distance in the left-right direction (right is positive), and "height" is the moving distance in up-down direction (upward is positive). ) Is shown.

【0064】例えば荷取作業時は、「距離Xfp」、「横
Yfp」、「高さZfp」の位置決め情報が文字情報で描画
され、荷置作業時は「距離Xfr」、「横Yfr」、「高さ
Zfr」の位置決め情報が文字情報で描画される。このた
め、画面28A上に文字情報で表示された各方向の距離
を見ることにより、フォーク2をどの方向にどれだけの
距離だけ移動させればよいかが容易に分かる。
For example, positioning information such as "distance Xfp", "horizontal Yfp", and "height Zfp" is drawn as character information during the loading operation, and "distance Xfr", "horizontal Yfr" during the loading operation. Positioning information of "height Zfr" is drawn as character information. Therefore, by looking at the distances displayed in the character information on the screen 28A in the respective directions, it is possible to easily understand in which direction and by what distance the fork 2 should be moved.

【0065】そして、荷役制御部47は、ベクトルFP
が「0」になるような制御量指令値をソレノイド駆動回
路50に出力する。但し、本実施形態では、フォーク2
の上下方向および左右方向についてのみ自動位置制御を
行い、前後方向(リーチ方向)については運転者による
手動操作に任せている。このため、荷役制御部47は、
ベクトルFPのうちYZ成分を「0」とするよう算出し
たフォーク2の上下方向および左右方向の各シフト量に
応じた値を制御量指令値としてソレノイド駆動回路50
に出力する。これによりフォーク2は上下方向および左
右方向については自動で位置合わせされる。この結果、
フォーク2は荷取モード時はパレット41の差込穴41
Aに位置決めされ、荷置モード時は棚部42から所定距
離上方の目標位置に位置合わせされる。この位置合わせ
の後、リーチ操作を行ってマスト13をリーチさせるこ
とにより荷取作業または荷置作業が行われる。なお、フ
ォーク2のリーチ動作も自動制御で行ってもよい。
Then, the cargo handling control unit 47 determines that the vector FP
The control amount command value such that the value becomes “0” is output to the solenoid drive circuit 50. However, in the present embodiment, the fork 2
The automatic position control is performed only in the up-down direction and the left-right direction, and the front-back direction (reach direction) is left to manual operation by the driver. Therefore, the cargo handling control unit 47
The solenoid drive circuit 50 uses, as a control amount command value, a value corresponding to each vertical and horizontal shift amount of the fork 2 calculated so that the YZ component of the vector FP is set to "0".
Output to. As a result, the fork 2 is automatically aligned in the vertical direction and the horizontal direction. As a result,
The fork 2 has the insertion hole 41 of the pallet 41 in the loading mode.
It is positioned at A and is aligned with a target position that is a predetermined distance above the shelf 42 in the loading mode. After this alignment, the reach operation is performed to reach the mast 13 to perform the work of picking up or placing the work. The reach operation of the fork 2 may be automatically controlled.

【0066】次に移動目標点の演算方法について、図1
2(a),(b)を用いて説明する。ここで、同図12
(a)は実座標系、同図(b)は画面座標系である。図
12(a)に示すように、実座標系においてマークMを
含む仮想平面(YZ平面)Gを考える。この仮想平面G
は、カメラ24によって撮影され画面28Aに映し出さ
れる撮影領域に相当するもので、カメラ24の移動とと
もに一緒に移動するものと仮定する。荷取作業時を考え
たとき、フォーク2をパレット41に位置合わせするた
め、カメラ24が仮想平面Gと平行にベクトルFP(X
成分は考えない)移動すれば、このときカメラ24と共
に仮想平面Gが移動することで、仮想平面G上において
マークMは移動目標点マーク87へ向かって移動して原
点Oが移動目標点Tに一致する。よって、 ベクトルOT=−ベクトルFP … (8) と表される。
Next, referring to FIG.
2 (a) and 2 (b) will be described. Here, in FIG.
(A) is an actual coordinate system, and (b) is a screen coordinate system. As shown in FIG. 12A, consider a virtual plane (YZ plane) G including the mark M in the real coordinate system. This virtual plane G
Is equivalent to a photographing region photographed by the camera 24 and displayed on the screen 28A, and is assumed to move together with the movement of the camera 24. Considering the time of the loading operation, in order to align the fork 2 with the pallet 41, the camera 24 is parallel to the virtual plane G and the vector FP (X
If it moves, the virtual plane G moves together with the camera 24 at this time, so that the mark M moves toward the movement target point mark 87 on the virtual plane G and the origin O becomes the movement target point T. Match. Therefore, the vector OT = −vector FP (8)

【0067】また同図(b)に示すように、移動目標点
Tの画面座標を(It,Jt)とおく。実座標系で原点
O(画面座標(I,J))からカメラ位置Cを見たベク
トルOCの成分(Xc,Yc,Zc)は、画面座標
(I,J)を用いて、前記(2) ,(3) 式で表される。よ
って、移動目標点T(画面座標(It,Jt))からカ
メラ位置Cを見たベクトルTCの成分(Xtc,Ytc,Z
tc)についても、画面座標(It,Jt)を用いて、前
記(2) ,(3) 式の関係が同様に成り立つことから、以下
のように表される。 Ytc=d/D(It−H/2) … (9) Ztc=d/D(Jt−V/2) … (10) またベクトルTC=ベクトルOC−ベクトルOT … (11) の関係から、(8) 式の関係を(11)式に代入すると、 ベクトルTC=ベクトルOC+ベクトルFP … (12) ここで、 ベクトルFP=ベクトルOP−ベクトルCF−ベクトルOC …(13) (13)式の関係を(12)式に代入して、 ベクトルTC=ベクトルOP−ベクトルCF … (14) ここで、ベクトルOPの成分(Xp,Yp,Zp)、ベ
クトルCFの成分(Xcf,Ycf,Zcf)である。移動目
標点の座標(It,Jt)を求める方法は、マークMが
移動目標点Tに置き換わったと考えれば、前記(2),(3)
の式において、ベクトルOCの成分→ベクトルTCの成
分、I→It、J→Jtに置き換えて計算すればよい。
ベクトルTCの成分(Xtc,Ytc,Ztc)は、(14)式の
関係を用いて、 (Xtc,Ytc,Ztc)=(Xp,Yp,Zp)−(Xcf,Ycf,Zcf) =(Xp−Xcf,Yp−Ycf,Zp−Zcf) …(15) よって、(9) ,(15) 式から、 Yp−Ycf=d/D(It−H/2) … (16) また、(10),(15)式から、 Zp−Zcf=d/D(Jt−V/2) … (17) 上記(16),(17) 式をそれぞれIt,Jtについて解く
と、荷取作業のときの移動目標点Tの座標(It,J
t)が、前記(4) ,(5) 式のように求まる。
Further, as shown in FIG. 7B, the screen coordinates of the movement target point T are set to (It, Jt). The component (Xc, Yc, Zc) of the vector OC, which is obtained by looking at the camera position C from the origin O (screen coordinates (I, J)) in the real coordinate system, uses the screen coordinates (I, J) to obtain the above (2). , (3). Therefore, the component (Xtc, Ytc, Z) of the vector TC when the camera position C is viewed from the movement target point T (screen coordinates (It, Jt)).
Also for tc), since the relationships of the equations (2) and (3) are similarly established using the screen coordinates (It, Jt), they are expressed as follows. Ytc = d / D (It-H / 2) (9) Ztc = d / D (Jt-V / 2) (10) Further, from the relation of vector TC = vector OC-vector OT (11), Substituting the equation (8) into the equation (11), vector TC = vector OC + vector FP (12) Here, vector FP = vector OP−vector CF−vector OC ... (13) Equation (13) Substituting into equation (12), vector TC = vector OP-vector CF (14) Here, the components (Xp, Yp, Zp) of the vector OP and the components (Xcf, Ycf, Zcf) of the vector CF. Assuming that the mark M has been replaced by the movement target point T, the method of obtaining the coordinates (It, Jt) of the movement target point is the same as in (2) and (3) above.
In the equation (3), the calculation may be performed by substituting the components of the vector OC → the components of the vector TC with I → It and J → Jt.
The components (Xtc, Ytc, Ztc) of the vector TC are expressed by (Xtc, Ytc, Ztc) = (Xp, Yp, Zp)-(Xcf, Ycf, Zcf) = (Xp- Xcf, Yp-Ycf, Zp-Zcf) (15) Therefore, from the equations (9) and (15), Yp-Ycf = d / D (It-H / 2) (16) Further, (10), From the equation (15), Zp-Zcf = d / D (Jt-V / 2) (17) When the equations (16) and (17) are solved for It and Jt, respectively, the moving target at the time of the pickup operation is obtained. Coordinates of point T (It, J
t) is obtained as in the equations (4) and (5).

【0068】同様に、荷置作業時を考えると、フォーク
2を棚部42から所定距離(10〜20cm)上方の荷
置位置Rに位置合わせするため、カメラ24が仮想平面
Gと平行にベクトルFR(X成分は考えない)移動すれ
ば、このときカメラ24と共に仮想平面Gが移動するこ
とで、仮想平面G上においてマークM2は移動目標点マ
ーク87へ向かって移動して原点Oが移動目標点Tに一
致する。よって、 ベクトルOT=−ベクトルFR … (18) と表される。この(18)式を(11)式に代入すると、 ベクトルTC=ベクトルOC+ベクトルFR … (19) ここで、 ベクトルFR=ベクトルOR−ベクトルCF−ベクトルOC …(20) さらに(20)式の関係を(19) 式に代入して、 ベクトルTC=ベクトルOR−ベクトルCF … (21) ここで、ベクトルORの成分(Xr,Yr,Zr)、ベ
クトルCFの成分(Xcf,Ycf,Zcf)である。移動目
標点の座標(It,Jt)を求める方法は、マークMが
移動目標点Tに置き換わったと考えれば、前記(2),(3)
式において、ベクトルOCの成分→ベクトルTCの成
分、I→It、J→Jtに置き換えて計算すればよい。
ベクトルTCの成分(Xtc,Ytc,Ztc)は、(21)式の
関係を用いて、 (Xtc,Ytc,Ztc)=(Xr,Yr,Zr)−(Xcf,Ycf,Zcf) =(Xr−Xcf,Yr−Ycf,Zr−Zcf) … (22) 最終的に求めたいのは、最終到達点にマークMがあると
きの画面座標なので、上記(2),(3) 式に、前記(22) 式
の関係を代入し、移動目標点の座標(It,Jt)につ
いて解くと、荷置作業のときの移動目標点Tの座標が、
前記(6) ,(7) 式のように求まる。
Similarly, considering the loading operation, since the fork 2 is aligned with the loading position R which is a predetermined distance (10 to 20 cm) above the shelf 42, the camera 24 makes a vector parallel to the virtual plane G. If FR (not considering the X component) is moved, the virtual plane G moves together with the camera 24 at this time, so that the mark M2 moves toward the movement target point mark 87 on the virtual plane G and the origin O moves. Match point T. Therefore, the vector OT = −vector FR (18) Substituting this equation (18) into equation (11), vector TC = vector OC + vector FR (19) Here, vector FR = vector OR-vector CF-vector OC (20) Furthermore, the relationship of equation (20) To the equation (19), vector TC = vector OR-vector CF (21) where the components of the vector OR (Xr, Yr, Zr) and the components of the vector CF (Xcf, Ycf, Zcf). . Assuming that the mark M has been replaced by the movement target point T, the method of obtaining the coordinates (It, Jt) of the movement target point is the same as in (2) and (3) above.
In the formula, the calculation may be performed by substituting the components of the vector OC → the components of the vector TC with I → It and J → Jt.
The components (Xtc, Ytc, Ztc) of the vector TC are (Xtc, Ytc, Ztc) = (Xr, Yr, Zr) − (Xcf, Ycf, Zcf) = (Xr−) by using the relation of the equation (21). Xcf, Yr-Ycf, Zr-Zcf) (22) What is finally desired is the screen coordinates when the mark M is at the final reaching point. Therefore, in the above equations (2) and (3), (22) ) Substituting the relationship of the equation and solving for the coordinates (It, Jt) of the moving target point, the coordinates of the moving target point T during the loading operation are
It can be obtained as in Eqs. (6) and (7).

【0069】次に、フォーク自動位置合せ制御および移
動目標点マーク87の描画処理について説明する。まず
フォーク2が設定揚高を超える揚高にあるときには、カ
メラ24によって撮影された画像データを基に、マーク
Mを画像認識する画像認識処理(マーク認識処理)が行
われる。すなわち荷取モードであるとテンプレートT1
を用いてマークM1を認識する画像処理を行い、荷置モ
ードであればテンプレートT2を用いてマークM2を認
識する画像処理を行う。そして画像認識されたマークM
の画面上における位置データI,J,D値を求める。
Next, the automatic fork alignment control and the drawing process of the moving target point mark 87 will be described. First, when the fork 2 is at a lift higher than the set lift, image recognition processing (mark recognition processing) for recognizing the image of the mark M is performed based on the image data taken by the camera 24. That is, the template T1 in the pickup mode
Is used to perform the image processing for recognizing the mark M1, and in the loading mode, the template T2 is used to perform the image processing for recognizing the mark M2. Then, the mark M that has been image-recognized
The position data I, J, D values on the screen are calculated.

【0070】表示位置決定部84は、このうちのデータ
D値を用いて、移動目標点Tの座標(It,Jt)を演
算する。すなわち、荷取作業時は、データD値を用いて
式(4),(5) に従って移動目標点Tの座標(It,Jt)
を演算し、荷置作業時は、データD値を用いて式(6),
(7) に従って移動目標点Tの座標(It,Jt)を演算
する。この座標データ(It,Jt)は描画表示部77
に送られる。描画表示部77は、表示位置決定部84か
らの指示に従って描画データ記憶部78から表示マーク
用の図形データを読み出し、図13(a)に示すような
移動目標点マーク87を画像の上に重ねるように座標
(It,Jt)位置に表示する。
The display position determining section 84 calculates the coordinates (It, Jt) of the movement target point T using the data D value among them. That is, during the loading operation, the coordinates (It, Jt) of the moving target point T are calculated according to the equations (4) and (5) using the data D value.
Is calculated, and at the time of loading work, using the data D value, equation (6),
The coordinates (It, Jt) of the movement target point T are calculated according to (7). This coordinate data (It, Jt) is displayed in the drawing display unit 77.
Sent to. The drawing display unit 77 reads the graphic data for the display mark from the drawing data storage unit 78 according to the instruction from the display position determination unit 84, and superimposes the moving target point mark 87 as shown in FIG. 13A on the image. Is displayed at the coordinate (It, Jt) position.

【0071】荷取作業時の画面28Aには、フォーク2
がパレット41に位置合わせされる際にマークM1が最
終的に到達すべき移動目標点Tを指し示す移動目標点マ
ーク87が表示される。一方、荷置作業時の画面28A
には、フォーク2が棚部42から所定距離上方に位置合
わせされた際にマークM2が最終的に到達すべき移動目
標点Tを指し示す移動目標点マーク87が表示される。
The fork 2 is displayed on the screen 28A during the pickup work.
When the mark is aligned with the pallet 41, a moving target point mark 87 indicating the moving target point T that the mark M1 should finally reach is displayed. On the other hand, screen 28A during loading work
A moving target point mark 87 indicating the moving target point T that the mark M2 should finally reach when the fork 2 is positioned above the shelf 42 by a predetermined distance is displayed on the screen.

【0072】マルチレバー31の作動スイッチ38を操
作すると、フォーク自動位置合わせ制御が開始される。
荷役制御部47では、位置データI,J,D値を基にマ
ークMを原点Oとするカメラ24の相対位置座標(X
c,Yc,Zc)が算出される。そして、ベクトルFP
を零とすべくYc,Zc値を共に零にする制御量を求め
る。そして荷役制御部47はこの制御量を基にソレノイ
ド駆動回路44を介してリフト用電磁比例弁65,66
とサイドシフト用電磁比例弁68を電流値制御し、リフ
トシリンダ15A,15Bとサイドシフトシリンダ71
を必要に応じて駆動制御することでフォーク2を位置合
わせする。その結果、フォーク2が上下方向に−Zc移
動するとともに、左右方向に−Ycだけ移動する。
When the operation switch 38 of the multi-lever 31 is operated, the fork automatic positioning control is started.
In the cargo handling control section 47, based on the position data I, J, D values, the relative position coordinates (X
c, Yc, Zc) is calculated. And the vector FP
A control amount that makes both the Yc and Zc values zero so as to zero is obtained. Based on this control amount, the cargo handling control unit 47 causes the solenoid drive circuit 44 to operate the lift solenoid proportional valves 65, 66.
Current control of the side shift solenoid proportional valve 68 and the lift cylinders 15A and 15B and the side shift cylinder 71.
The fork 2 is aligned by controlling the drive of the fork 2 as required. As a result, the fork 2 moves by −Zc in the vertical direction and by −Yc in the horizontal direction.

【0073】フォーク2が移動することによって例えば
荷取作業時には、図13(b)に示すように、移動目標
点マーク87の中心点である移動目標点TにマークM1
の中心点が一致し、フォーク2は差込穴41Aに一致す
る荷取位置に位置決めされる。一方、荷置作業時には、
この移動目標点マーク87の中心点である移動目標点T
にマークM2の中心点が一致し、フォーク2は棚面42
Aから約10〜20cm上方の荷置位置に位置決めされ
る。
When the fork 2 is moved, for example, at the time of a load collecting work, as shown in FIG. 13B, the mark M1 is placed on the moving target point T which is the center point of the moving target point mark 87.
Of the fork 2 are aligned with each other, and the fork 2 is positioned at a loading position that is aligned with the insertion hole 41A. On the other hand, during loading work,
The movement target point T which is the center point of the movement target point mark 87
The center point of the mark M2 coincides with, and the fork 2 has a shelf surface 42.
It is positioned at a loading position about 10 to 20 cm above A.

【0074】このようにマークMが移動すべき移動目標
点Tを画面28A上で見ることができるので、マークM
と移動目標点マーク87の各中心点の一致を確認するこ
とで、フォーク2が位置決めされたかどうかを容易に視
認することができる。また、荷役作業時に作業者が意図
する荷役対象にフォーク2が正しく位置合せされたかど
うかを判断することもできる。
In this way, since the moving target point T to which the mark M should move can be seen on the screen 28A, the mark M
By confirming that the center points of the movement target point mark 87 coincide with each other, it is possible to easily visually recognize whether or not the fork 2 is positioned. It is also possible to judge whether or not the fork 2 is properly aligned with the cargo handling target intended by the worker during the cargo handling work.

【0075】この実施の形態では、以下の効果が得られ
る。 (1)フォーク自動位置合わせ制御が行われる際、画面
28Aには荷役対象に付されたマークMの移動目標点を
示す移動目標点マーク87が画像上に描画される。よっ
て、画面28A上における移動目標点マーク87の描画
位置から、フォーク2を荷役対象に位置合わせするとき
にマークMを移動させるべき移動目標点を画面28Aか
ら一目で視認できる。よって、運転者が意図する荷役対
象に付されたマークMが移動目標点マーク87に向かっ
て画面28A上を移動する過程から、フォーク2が位置
合わせされる様子を確認できる。そして、画面28A上
で両マークM,87が一致したことをもって、フォーク
2の自動位置合わせ制御が完了したことを画面28Aを
通して知ることができる。
In this embodiment, the following effects can be obtained. (1) When the fork automatic alignment control is performed, a moving target point mark 87 indicating the moving target point of the mark M attached to the cargo handling target is drawn on the screen 28A on the image. Therefore, from the drawing position of the moving target point mark 87 on the screen 28A, the moving target point to which the mark M should be moved when the fork 2 is aligned with the cargo handling target can be visually recognized from the screen 28A at a glance. Therefore, from the process in which the mark M attached to the cargo handling target intended by the driver moves on the screen 28A toward the movement target point mark 87, it is possible to confirm how the forks 2 are aligned. Then, the fact that the marks M and 87 match on the screen 28A makes it possible to know through the screen 28A that the automatic alignment control of the fork 2 has been completed.

【0076】(2)荷役対象に付された位置検出用のマ
ークM(画像認識対象)を選びその移動目標点にマーク
87を描画する手法を採用したので、画面28A上に表
示または描画された2つのマークM,87に着目すれば
これらの位置関係からフォーク2の位置合わせの様子を
容易に把握することができる。
(2) Since the position detection mark M (image recognition target) attached to the cargo handling target is selected and the mark 87 is drawn at the moving target point, it is displayed or drawn on the screen 28A. Focusing on the two marks M and 87, the positional alignment of the fork 2 can be easily understood from the positional relationship between them.

【0077】(3)移動目標点マーク87と一致したマ
ークMがパレット41のものか棚部42のものかを見る
ことで、フォーク2の位置合わせが成功したかミスした
かを画面28A上の画像を通して簡単に見つけることが
できる。
(3) Whether the alignment of the fork 2 has succeeded or missed is checked on the screen 28A by checking whether the mark M which coincides with the movement target point mark 87 belongs to the pallet 41 or the shelf 42. You can easily find it through the image.

【0078】(4)フォーク2と荷役対象41,42と
の3方向(X,Y,Z方向)のずれ量を画面28A上に
数値で描画するようにしたので、フォーク2をどの方向
にどれだけの距離移動させればよいかを運転者は知るこ
とができる。
(4) Since the deviation amounts of the fork 2 and the cargo handling objects 41, 42 in the three directions (X, Y, Z directions) are drawn numerically on the screen 28A, which direction of the fork 2 is determined. The driver can know whether or not to move the distance.

【0079】(5)フォーク自動位置合わせ制御におい
て、運転者は制御があとどのくらいで終了するかを知る
ことができ、制御が順調に進行している安心感、制御終
了時の次の動作へのタイムリーな心構えを得ることがで
きる。
(5) In the automatic fork alignment control, the driver can know how long the control will end, the sense of security that the control is proceeding smoothly, and the next operation at the end of the control. You can get a timely attitude.

【0080】(6)荷取モードと荷置モードを区別して
移動目標点マーク87を描画するので、どちらの荷役モ
ードにも対応できる。 (7)カメラ24(カメラユニット23)をキャリッジ
14に対し昇降する昇降式とし、荷役作業の種別(荷取
作業・荷置作業)に応じて格納位置と下降位置の二位置
にカメラ24を移動配置するようにした。この結果、フ
ォーク2上に荷の無い荷取作業時には、格納位置に配置
されたカメラ24によってフォーク2と略同じ高さから
作業エリアを撮影でき、一方、フォーク2上に荷のある
荷置作業時には、下降位置に配置されたカメラ24によ
って荷に遮られることなく作業エリアを撮影できる。従
って、画面28Aに映し出された画像の撮影角度がフォ
ーク2の位置合わせに都合がよい。
(6) Since the moving target point mark 87 is drawn by distinguishing between the loading mode and the loading mode, either loading mode can be supported. (7) The camera 24 (camera unit 23) is of a lifting type that moves up and down with respect to the carriage 14, and the camera 24 is moved to two positions, a storage position and a lowered position, according to the type of cargo handling work (loading work / loading work). I arranged it. As a result, at the time of picking up work with no load on the fork 2, the work area can be photographed from the substantially same height as the fork 2 by the camera 24 arranged at the storage position, while the work for placing a load on the fork 2 can be performed. At times, the work area can be photographed by the camera 24 arranged in the lowered position without being blocked by the load. Therefore, the shooting angle of the image displayed on the screen 28A is convenient for aligning the fork 2.

【0081】(8)高所での荷役作業を支援するために
設けたカメラ24および表示装置28を利用し、その表
示装置28の画面28Aに移動目標点を視認させるため
の目印となる移動目標点マーク87を描画させる。つま
り、カメラ24に撮影された画像データを用いた画像認
識処理によりマークMの位置を割り出し、フォーク自動
位置合わせ制御のために求めたこのマークMの位置デー
タ(I,J,D)を利用して移動目標点の座標を算出し
て移動目標点マーク87の描画位置を求める。従って、
移動目標点の位置算出だけのために追加される演算処理
が少しで済み、移動目標点マーク87を画面28Aに描
画する描画処理を追加しても、フォーク自動位置合わせ
制御のためのCPUの処理負担をさほど増やさずに済
む。
(8) A moving target serving as a mark for visually recognizing the moving target point on the screen 28A of the display device 28 by using the camera 24 and the display device 28 provided to support the cargo handling work at a high place. The point mark 87 is drawn. That is, the position of the mark M is determined by the image recognition process using the image data captured by the camera 24, and the position data (I, J, D) of the mark M obtained for the automatic fork alignment control is used. Then, the coordinates of the moving target point are calculated to obtain the drawing position of the moving target point mark 87. Therefore,
A small amount of calculation processing is added only for calculating the position of the moving target point, and even if the drawing processing for drawing the moving target point mark 87 on the screen 28A is added, the processing of the CPU for the automatic fork position adjustment control is performed. It does not have to increase the burden.

【0082】(第2の実施形態)この実施形態では、カ
メラがマストの構成部材に固定されているカメラ固定式
の荷役作業支援装置を採用する。
(Second Embodiment) In this embodiment, a camera-fixing type cargo handling work support device in which a camera is fixed to a component member of a mast is adopted.

【0083】図14に示すように、マスト13は外側か
ら順にアウタマスト91、ミドルマスト92およびイン
ナマスト93により構成されている。インナマスト93
の高さ方向中央よりやや上方位置にはビーム94が横架
されており、このビーム94の下側にはカメラ95がビ
ーム94に固定された状態で取り付けられている。カメ
ラ95はその撮影部95Aによりフォーク2の作業エリ
アを撮影可能に前方を向く状態に配置されている。
As shown in FIG. 14, the mast 13 is composed of an outer mast 91, a middle mast 92 and an inner mast 93 in order from the outside. Inner Must 93
A beam 94 is laterally provided at a position slightly higher than the center in the height direction, and a camera 95 is fixed to the beam 94 below the beam 94. The camera 95 is arranged so as to face forward so that the work area of the fork 2 can be photographed by the photographing section 95A.

【0084】図15は、荷役装置(マスト装置)の上部
を正面から見たもので、キャリッジ14はインナマスト
13Cの最上位置に配置されている。キャリッジ14が
インナマスト93の最上位置に配置された状態におい
て、カメラ95はフォーク2の所定距離下方に位置し、
左右方向(車幅方向)にはキャリッジ14がサイドシフ
トしていない状態下で一対のフォーク2間中心線上に位
置する。マスト13はキャリッジ14がインナマスト9
3の最上位置に一旦到達後はじめてスライド伸長を開始
するテレスコピック型(フルフリー型)である。このた
め、キャリッジ14がインナマスト93の最上位置に到
達したの後のマスト伸長時、すなわちキャリッジ14が
インナマスト93の最上位置に到達した所定揚高以上の
揚高では、フォーク2とカメラ95との位置関係は上下
方向において常に一定に保たれる。
FIG. 15 is a front view of the upper portion of the cargo handling device (mast device). The carriage 14 is disposed at the uppermost position of the inner mast 13C. In a state where the carriage 14 is arranged at the uppermost position of the inner mast 93, the camera 95 is positioned below the fork 2 by a predetermined distance,
The carriage 14 is positioned on the center line between the pair of forks 2 in the left-right direction (vehicle width direction) in a state where the carriage 14 is not side-shifted. As for the mast 13, the carriage 14 has an inner mast 9
It is a telescopic type (full free type) that starts sliding extension only after reaching the uppermost position of 3. Therefore, when the mast extends after the carriage 14 reaches the uppermost position of the inner mast 93, that is, when the carriage 14 reaches the uppermost position of the inner mast 93 and the lift is equal to or higher than a predetermined lift, the positions of the fork 2 and the camera 95 are increased. The relationship is always kept constant in the vertical direction.

【0085】図15にけるカメラ95の位置は、フォー
ク2に対し前記第1の実施形態におけるカメラ下降時の
位置にほぼ相当しており、フォーク2上に荷が積載され
ている荷置作業時にもそのときの荷役対象である棚部4
2に付されたマークM2を撮影できるようになってい
る。もちろん、フォーク2上に荷が積載されていない荷
取作業時にはそのときの荷役対象であるパレット41に
付されたマークM1を撮影できるようになっている。こ
のようにカメラ95がインナマスト93に固定されてい
る点が前記第1の実施形態と異なるのみで、カメラ95
が電気的に接続されたコントローラ45は、前記第1の
実施形態と同様に、カメラ95に撮影された画像データ
を用いた画像処理および荷役制御などを司る。
The position of the camera 95 in FIG. 15 substantially corresponds to the position of the fork 2 when the camera is lowered in the first embodiment, and is used during a loading operation in which a load is loaded on the fork 2. Shelf 4 that is also the target of cargo handling at that time
The mark M2 attached to 2 can be photographed. Of course, when the load is not loaded on the fork 2, the mark M1 attached to the pallet 41 that is the target of the load handling at that time can be photographed. In this way, the camera 95 is fixed to the inner mast 93 only in the difference from the first embodiment.
The controller 45 electrically connected to is responsible for image processing and cargo handling control using image data captured by the camera 95, as in the first embodiment.

【0086】サイドシフトシリンダ71にはストローク
センサ73が設けられており、ストロークセンサ73に
よりサイドシフトシリンダ71のストローク量が検出さ
れる。ストロークセンサ73の検出結果によりフォーク
2のサイドシフト量が把握され、フォーク2とカメラ9
5との左右方向(Y方向)の相対位置関係、すなわちカ
メラ95とフォーク2のY方向のずれ量が把握される。
The side shift cylinder 71 is provided with a stroke sensor 73, and the stroke sensor 73 detects the stroke amount of the side shift cylinder 71. The side shift amount of the fork 2 is grasped by the detection result of the stroke sensor 73, and the fork 2 and the camera 9 are detected.
The relative positional relationship with the right and left direction (Y direction) with respect to 5, that is, the shift amount of the camera 95 and the fork 2 in the Y direction is grasped.

【0087】図16は、荷役操作支援装置20の電気構
成ブロックを示す。同図に示すように、荷役操作支援装
置20は、前記第1の実施形態と基本的に同様の電気的
構成であり、昇降式のカメラに替え、インナマスト93
に固定された固定式のカメラ95を採用する点が異なる
のみである。従って、前記第1の実施形態の電気的構成
に比べてカメラ昇降装置用のセンサ類およびアクチュエ
ータが廃止された構成となっている。本実施形態では、
ストロークセンサ73の計測値から求められたカメラ9
5とフォーク2のY方向のずれ量を用いて、移動目標
点、およびフォーク2と荷役対象とのX,Y,Z方向の
ずれ量が計算されるようになっている。
FIG. 16 shows an electrical block of the cargo handling operation support device 20. As shown in the figure, the cargo handling operation support device 20 has basically the same electrical configuration as that of the first embodiment, and instead of a lifting type camera, an inner mast 93 is used.
The only difference is the use of a fixed camera 95 fixed to. Therefore, as compared with the electrical configuration of the first embodiment, the sensors and actuators for the camera lifting device are eliminated. In this embodiment,
The camera 9 obtained from the measurement value of the stroke sensor 73
The displacement amount in the Y direction between the fork 5 and the fork 2 is used to calculate the displacement amount in the X, Y, and Z directions between the movement target point and the target for cargo handling.

【0088】次にカメラ24がインナマスト13Cに固
定された本実施形態における移動目標点の計算方法につ
いて説明する。荷取作業時にフォーク2をパレット41
に位置合わせするために画面28A上でマークM1を移
動させるべき移動目標点の座標(It,Jt)は、前記
第1の実施形態と同様に次式により与えられる。 It=H/2+(Yp−Ycf)*D/d … (4) Jt=V/2+(Zp−Zcf)*D/d … (5) ここで、Itは画面上の移動目標点横座標、Jtは画面上
の移動目標点縦座標、Hは画面の横方向画素数、Vは画
面の縦方向画素数、Ypはフォーク根元左右中心の移動
目標点をマークM1から見た横座標、Zpはフォーク根
元左右中心の移動目標点をマークM1から見た縦座標、
Ycfはフォーク根元左右中心をカメラから見た横座標、
Ycfはフォーク根元左右中心をカメラから見た縦座標、
dは実際のマークの距離、Dは画像処理により取得した
マークサイズ[画素]、Ycfはストロークセンサ73を用
いて計測および算出する。Yp,Zp、Ycf、Zcfは、
既知の値である。
Next, a method of calculating the moving target point in this embodiment in which the camera 24 is fixed to the inner mast 13C will be described. Fork 2 is placed on the pallet 41 during the loading operation
The coordinates (It, Jt) of the movement target point for moving the mark M1 on the screen 28A for the purpose of aligning the position are given by the following equations as in the first embodiment. It = H / 2 + (Yp-Ycf) * D / d (4) Jt = V / 2 + (Zp-Zcf) * D / d (5) where It is the abscissa of the moving target point on the screen, Jt is the ordinate of the movement target point on the screen, H is the number of pixels in the horizontal direction of the screen, V is the number of pixels in the vertical direction of the screen, Yp is the abscissa of the movement target point at the left and right center of the fork root seen from the mark M1, and Zp is The ordinate of the movement target point of the center of the fork root, which is seen from the mark M1,
Ycf is the abscissa of the center of the fork root as seen from the camera,
Ycf is the ordinate of the left and right center of the fork as seen from the camera,
d is the actual mark distance, D is the mark size [pixel] acquired by image processing, and Ycf is measured and calculated using the stroke sensor 73. Yp, Zp, Ycf, Zcf are
It is a known value.

【0089】また荷置作業時にフォーク2を棚部42に
対し棚面42Aから所定距離(10〜20cm)上方の
荷置位置Rに位置合わせするために画面28A上でマー
クM2を移動させるべき移動目標点の座標(It,J
t)は、次式により与えられる。 It=H/2+(Yr−Ycf)*D/d … (6) Jt=V/2+(Zr−Zcf)*D/d … (7) ここで、Yrはフォーク根元左右中心の移動目標点をマ
ークM2から見た横座標、Zrはフォーク根元左右中心
の移動目標点をマークM2から見た縦座標であり、共に
既知の値である。
Further, at the time of loading operation, the mark M2 should be moved on the screen 28A in order to align the fork 2 with the loading position R above the shelf 42 by a predetermined distance (10 to 20 cm) from the shelf surface 42A. Coordinates of target point (It, J
t) is given by the following equation. It = H / 2 + (Yr-Ycf) * D / d (6) Jt = V / 2 + (Zr-Zcf) * D / d (7) where Yr is the movement target point of the fork root left and right center. The abscissa as viewed from the mark M2 and Zr are ordinates as viewed from the mark M2 of the movement target point of the fork root left and right center, and both are known values.

【0090】前記第1の実施形態では、カメラ24がサ
イドシフタ16に付いておりフォーク2と共に動くため
Ycfは固定値であったが、本実施形態ではサイドシフト
によりフォーク2が横方向に動いてもカメラ24は動か
ないので、Ycfはサイドシフトの状態によって変化する
変数となる。従って、上記(4),(6)式において、Ycfは
例えばストロークセンサ73で計測して求める。
In the first embodiment, since the camera 24 is attached to the side shifter 16 and moves with the fork 2, Ycf has a fixed value, but in the present embodiment, the side shift causes the fork 2 to move laterally. Since the camera 24 does not move, Ycf is a variable that changes depending on the side shift state. Therefore, in the above equations (4) and (6), Ycf is measured and obtained by the stroke sensor 73, for example.

【0091】ストロークセンサ73により、サイドシフ
トシリンダ76が一杯に伸びた状態からの縮み量ΔYを
測定し、ΔY=0のときのYcfをYcf0とすると、Ycf
は次式で表される。 Ycf=Ycf0+ΔY … (23) この(23)式を(4),(6)式の「It」値を求める計算式に代
入すれば以下の式が求まる。 It=H/2+(Yp−Ycf0−ΔY) * D/d … (24) It=H/2+(Yr−Ycf0−ΔY) * D/d … (25) ここで、Ycf0は、サイドシフトシリンダ71が伸びき
った際にフォーク根元左右中心をカメラ24から見た横
座標、ΔYは、サイドシフトシリンダ71が一杯に伸び
きった状態からの縮み量(ストロークセンサ73により
計測)、Zcfは、フォーク根元左右中心をカメラから見
た縦座標である。
The stroke sensor 73 measures the amount of contraction ΔY from the state where the side shift cylinder 76 is fully extended, and when Ycf when ΔY = 0 is Ycf0, Ycf
Is expressed by the following equation. Ycf = Ycf0 + ΔY (23) The following formula is obtained by substituting the formula (23) into the formula for calculating the “It” value of the formulas (4) and (6). It = H / 2 + (Yp-Ycf0-ΔY) * D / d (24) It = H / 2 + (Yr-Ycf0-ΔY) * D / d (25) where Ycf0 is the side shift cylinder 71. Is the abscissa of the center of the fork root when viewed from the camera 24 when fully extended, ΔY is the amount of contraction (measured by the stroke sensor 73) after the side shift cylinder 71 is fully extended, and Zcf is the fork root. It is the ordinate of the horizontal center as seen from the camera.

【0092】この第2の実施形態によれば、以下の効果
が得られる。 (9)カメラ24をインナマスト93に固定しているの
で、前記第1の実施形態で採用したカメラ昇降装置を不
要にでき、カメラ24を有する撮影システムを簡易構造
かつ低コストで実現することができる。しかも、画面2
8A上には移動目標点マーク87が描画されることによ
り、運転者は画面28Aの画像上に描画されたマーク8
7からフォーク2を移動させるべき移動目標点を一目で
視認できる。従って、第1の実施形態で述べた効果
(1)〜(6),(8)も同様に得られる。
According to the second embodiment, the following effects can be obtained. (9) Since the camera 24 is fixed to the inner mast 93, the camera lifting device adopted in the first embodiment can be dispensed with, and the photographing system having the camera 24 can be realized with a simple structure and at low cost. . Moreover, screen 2
By drawing the moving target point mark 87 on 8A, the driver can move the mark 8 drawn on the image on the screen 28A.
The movement target point to move the fork 2 from 7 can be visually recognized at a glance. Therefore, the effects (1) to (6) and (8) described in the first embodiment can be obtained similarly.

【0093】(第3の実施形態)この実施形態は、フォ
ークを自動位置合わせする自動制御が採用されていない
点が前記各実施形態と異なる。図17は荷役操作支援装
置の電気構成ブロックを示す。カメラ95は前記第2の
実施形態と同様でインナマスト93に固定された固定式
である。
(Third Embodiment) This embodiment is different from the above-mentioned embodiments in that the automatic control for automatically aligning the forks is not adopted. FIG. 17 shows an electrical block of the cargo handling operation support device. The camera 95 is a fixed type fixed to the inner mast 93 as in the second embodiment.

【0094】荷役制御部47は、自動位置合わせ制御を
行わないため、相対座標算出部85および制御量算出部
86は廃止されている。荷役制御部47には、運転席9
のインストルメントパネルに設けられた荷役レバー、す
なわちリフトレバー96、リーチレバー97、サイドシ
フトレバー98およびティルトレバー99の操作を検出
する各センサ101〜104およびセンサ58〜60,
96が電気的に接続されている。荷役制御部47は、各
センサ101〜104の信号を基にソレノイド駆動回路
50を介して電磁比例弁のソレノイド65〜69を電流
値制御し、各レバー96〜99の操作に応じてシリンダ
12,15A,15B,71,72を駆動制御する。な
お、レバー96,98により手動操作手段が構成され
る。
Since the cargo handling control unit 47 does not perform the automatic alignment control, the relative coordinate calculation unit 85 and the control amount calculation unit 86 are eliminated. The cargo handling control unit 47 includes a driver's seat 9
Sensors 101 to 104 and sensors 58 to 60 for detecting operations of the cargo handling levers provided on the instrument panel, that is, the lift lever 96, the reach lever 97, the side shift lever 98, and the tilt lever 99.
96 is electrically connected. The cargo handling control unit 47 controls the solenoids 65 to 69 of the solenoid proportional valves via the solenoid drive circuit 50 based on the signals from the sensors 101 to 104, and controls the current values of the solenoids 65 to 69. The drive control of 15A, 15B, 71, 72 is carried out. The levers 96 and 98 constitute a manual operation means.

【0095】このようにレバーを手動操作してシリンダ
を駆動制御する手動操作式であるが、高揚高の作業エリ
アをカメラ95で撮影した画像は表示装置28の画面2
8A上に表示される。画像制御部46は、前記各実施形
態と同様の構成を有しており、カメラ95で撮影された
画像データを基に、マークの画像認識処理、マークの位
置データ演算処理、移動目標点算出処理、移動目標点マ
ークなどの位置決め情報の描画処理などを司る。
As described above, the manual operation type in which the lever is manually operated to control the drive of the cylinder is used. However, the image taken by the camera 95 in the high lift work area is displayed on the screen 2 of the display device 28.
It is displayed on 8A. The image control unit 46 has the same configuration as that of each of the above-described embodiments, and based on the image data captured by the camera 95, the mark image recognition process, the mark position data calculation process, and the movement target point calculation process. , Controls drawing processing of positioning information such as moving target point mark.

【0096】よって、画面28A上には、所定揚高以上
の揚高にあるときには、フォーク2の移動目標点を知ら
せる移動目標点マーク87が描画されることになる。こ
のため、高揚高で撮影された高所での作業エリアの画像
が表示装置28の画面28Aに表示され、画面28Aを
見ながらフォーク2の位置合わせを手動操作で行うとき
に、その移動目標点をマーク87から視認することがで
きる。また画面28A上にはフォーク2と荷役対象4
1,42とのX,Y,Z方向のずれ量も描画される。よ
って、前記各実施形態と同様に効果(2),(4)〜
(6)を得ることができる。
Therefore, the moving target point mark 87 for notifying the moving target point of the fork 2 is drawn on the screen 28A when the lift is higher than the predetermined lift. Therefore, an image of the work area at a high place captured at high lift is displayed on the screen 28A of the display device 28, and when the fork 2 is manually adjusted while watching the screen 28A, the movement target point Can be visually recognized from the mark 87. Also, the fork 2 and the cargo handling target 4 are displayed on the screen 28A.
The amount of shift in the X, Y, and Z directions with respect to 1, 42 is also drawn. Therefore, the effects (2), (4) to
(6) can be obtained.

【0097】(10)運転者は画面28A上に描画され
たフォーク2と荷役対象41,42との3方向のずれ量
(移動距離)が「0」になるように荷役操作すれば、フ
ォーク2を荷役対象41,42に確実に位置決めするこ
とができる。よって、高揚高など目視しにくい位置での
荷役作業効率を向上させることができる。
(10) If the driver carries out the cargo handling operation so that the displacement amount (moving distance) between the fork 2 and the cargo handling objects 41 and 42 drawn on the screen 28A in the three directions becomes "0", the fork 2 Can be reliably positioned on the cargo handling objects 41 and 42. Therefore, it is possible to improve the cargo handling work efficiency at a position where it is difficult to visually recognize such as high lift.

【0098】なお、実施の形態は上記に限定されず、次
の態様で実施することもできる。 ○前記各実施形態では、荷役作業内容が荷取作業か荷置
作業かを荷重センサの検出値を基に判別し、その判別し
た荷役作業の種別に応じて目標とするマークMを決定
し、荷役対象をパレットとするか棚部とするかを決定す
る構成とした。これに対し例えば運転席のインストルメ
ントパネル上に荷役作業を指定するために操作するボタ
ンを設け、運転者がボタン操作により自ら荷役作業の種
別をコントローラに対し指定する方法を採用することも
できる。
The embodiment is not limited to the above, and can be implemented in the following modes. In each of the above-described embodiments, whether the contents of the cargo handling work is a unloading work or a laying work is determined based on the detection value of the load sensor, and the target mark M is determined according to the determined type of the cargo handling work. It is configured to decide whether the cargo handling target is a pallet or a shelf. On the other hand, for example, it is possible to adopt a method in which a button to be operated for designating the cargo handling work is provided on the instrument panel of the driver's seat and the driver himself / herself specifies the type of the cargo handling work to the controller by operating the button.

【0099】○ カメラが撮影した画像データを基に画
像認識処理をする対象(被画像認識対象)は、荷役対象
に付されたマークM1,M2に限定されない。例えばパ
レット41または棚部42の形状等をパターンとして画
像認識処理をし荷役対象の位置を割り出す手法を採用す
ることもできる。
The target (image recognition target) for which the image recognition processing is performed based on the image data captured by the camera is not limited to the marks M1 and M2 attached to the cargo handling target. For example, a method of performing image recognition processing using the shape of the pallet 41 or the shelves 42 as a pattern to determine the position of the cargo handling target can be adopted.

【0100】○ 移動目標点マーク87のデザインは、
前記各実施形態のものに限定されない。移動目標点を特
定できる形状であれば足りる。例えば移動目標点を指し
示す矢印図形など方向性を持つ形状の図形を採用するこ
とができる。また移動目標点に重心が一致するように丸
や三角、四角、多角形などの所定形状のマークを描画し
てもよい。移動目標点を示す目印として画面に表示する
マークは、任意のデザインや図形とすることができる。
例えば「十字」、「点」「線(ライン)」などでもよ
い。例えば十字線であれば、マークMの重心が十字線を
構成する縦横の2本の線にそれぞれ一致するように位置
合わせすればよいので、手動操作方式の場合にフォーク
の位置合わせ操作がし易い。さらに放射状の図形やその
他の線図、イラストでもよい。但し、前記各実施形態で
用いたような点対象の性質を持つ図形であると、一点を
特定し易いので好ましい。また目印(目標点標識)は、
静止画像に限らず動画画像(アニメーション)であって
も構わない。またマークを点滅させてもよく、マークが
時間経過とともに色変化してもよい。フォークをパレッ
トの穴に挿入可能な位置範囲を位置合わせ範囲と見なせ
るので、この位置合わせ範囲内にフォークが位置合わせ
されたときにその旨を運転者に視覚的に知らせるため
に、目印の表示色を変えるようにしてもよい。
○ The design of the moving target point mark 87 is
The present invention is not limited to the above embodiments. A shape that can specify the movement target point is sufficient. For example, a directional graphic such as an arrow graphic indicating a movement target point can be adopted. Further, a mark having a predetermined shape such as a circle, a triangle, a square, or a polygon may be drawn so that the center of gravity coincides with the movement target point. The mark displayed on the screen as the mark indicating the movement target point can be any design or figure.
For example, "cross", "dot", "line", etc. may be used. For example, in the case of a cross line, it is only necessary to perform alignment so that the center of gravity of the mark M coincides with the two vertical and horizontal lines that form the cross line. Therefore, in the case of the manual operation method, the fork alignment operation is easy. . Further, radial figures and other diagrams and illustrations may be used. However, it is preferable to use a figure having the property of point object as used in each of the above-described embodiments, since it is easy to specify one point. The mark (target point mark) is
The moving image (animation) is not limited to the still image. Further, the mark may be blinked, and the color of the mark may change over time. Since the position range in which the fork can be inserted into the hole of the pallet can be regarded as the alignment range, the indicator color of the mark is used to visually inform the driver when the fork is aligned within this alignment range. May be changed.

【0101】○ 移動目標点を運転者に視覚的に知らせ
ることができれば必ずしも移動目標点の位置にマークを
表示することに限定はされない。例えば移動目標点のI
座標とJ座標を個々に指し示す2つの目印を、画面28
Aの縦と横の二辺に沿って描画し、両目印からI座標と
J座標を特定することで移動目標点を画面上に特定する
手法を採用することもできる。
The mark is not necessarily limited to being displayed at the position of the moving target point as long as the driver can be visually notified of the moving target point. For example, I of the movement target point
On the screen 28, there are two marks that individually indicate the coordinates and the J coordinate.
It is also possible to adopt a method in which the movement target point is specified on the screen by drawing along the vertical and horizontal two sides of A and specifying the I coordinate and the J coordinate from both marks.

【0102】○ 画像認識マークとして放射状の図形を
採用したが、このような図形に限定されない。四角
(■)や三角(▲)などの単純図形でもよい。パターン
マッチングによりテンプレートを多数用意する必要があ
って画像認識処理に時間を要することにはなるが、荷役
対象の位置検出はすることができる。またパターンマッ
チング以外の画像認識方法を採用し、荷役対象の位置検
出を行ってもよい。さらに画像認識以外の方法を用いて
移動目標点座標を求める方法を採用することもできる。
例えばパレットや棚部などの荷役対象に付した被検出部
をセンサにより検出することにより荷役対象の位置を検
出する方法を採用できる。
Although a radial figure is adopted as the image recognition mark, the invention is not limited to such a figure. It may be a simple figure such as a square (■) or triangle (▲). Although it is necessary to prepare a large number of templates by pattern matching and it takes time for the image recognition processing, the position of the cargo handling target can be detected. An image recognition method other than pattern matching may be adopted to detect the position of the cargo handling target. Furthermore, it is also possible to adopt a method of obtaining the coordinates of the moving target point using a method other than image recognition.
For example, it is possible to employ a method of detecting the position of the cargo handling target by detecting a detected portion attached to the cargo handling target such as a pallet or a shelf.

【0103】○ 位置決め情報とは、荷役機器を荷役対
象に位置決めする際の方向およびずれ量が分かる情報で
あれば足りる。すなわち前記実施形態のように位置決め
のためにフォーク2をシフトさせる距離そのものである
必要はない。例えば画面のスケールを100としてYZ
方向の位置決めのためのシフト量を相対的な量として示
すゲージを描画させても構わない。
The positioning information is sufficient if it is information that indicates the direction and the amount of deviation when the cargo handling device is positioned on the cargo handling target. That is, the distance itself for shifting the fork 2 for positioning need not be the same as in the above embodiment. For example, if the screen scale is 100, YZ
A gauge indicating a relative shift amount for directional positioning may be drawn.

【0104】○ 前記各実施形態における移動目標点マ
ーク87は、画面28A上におけるマークMの移動目標
点としたが、マークMの移動目標点とする必要は必ずし
もない。例えばパレット41の一方(例えば右側)の穴
41Aを基準とし、この穴41Aの移動目標点を指し示
す移動目標点マークを描画してもよい。要するに荷役機
器を荷役対象に位置合わせするときに都合のよい基準点
をどこかに決め、荷役機器を荷役対象に位置合わせする
ときにその基準点を移動させるべき移動目標点を指し示
す目印が描画されれば足りる。そして、この基準点はそ
の役割を果たしえる限り車両以外のどこに決めてもよ
く、荷役対象の一部、荷役対象の周辺の特定箇所(例え
ば棚の特定箇所)、あるいはこれらの部位や箇所に付さ
れた目印(マーク)とすることもできる。基準点を目印
(マーク)とする場合、そのマークは画像認識用のマー
クを流用する必要は必ずしもなく、基準点用のマークを
マークM1,M2とは別に設けることもできる。
The movement target point mark 87 in each of the above embodiments is the movement target point of the mark M on the screen 28A, but it does not necessarily have to be the movement target point of the mark M. For example, a hole 41A on one side (for example, the right side) of the pallet 41 may be used as a reference, and a moving target point mark indicating the moving target point of the hole 41A may be drawn. In short, decide a convenient reference point somewhere when aligning the cargo handling equipment with the cargo handling target, and draw a mark that indicates the movement target point that should move the reference point when aligning the cargo handling equipment with the cargo handling target. It's enough. This reference point may be set anywhere other than the vehicle as long as it can play its role, and it may be attached to a part of the cargo handling target, a specific location around the cargo handling target (for example, a specific location on the shelf), or these parts or locations. It can also be a marked mark. When the reference point is used as a mark (mark), it is not always necessary to use the mark for image recognition as the mark, and the mark for the reference point may be provided separately from the marks M1 and M2.

【0105】○ 前記各実施形態では、移動目標点マー
クによってフォーク2を上下方向および左右方向に位置
決めできるようにしたが、上下または左右の1方向のみ
に位置決めできる移動目標点マークを画面に表示させて
もよい。
In each of the above-described embodiments, the fork 2 can be positioned in the vertical direction and the horizontal direction by the moving target point mark. However, the moving target point mark that can be positioned only in one of the vertical and horizontal directions is displayed on the screen. May be.

【0106】○ 第3の実施形態のようにフォークの位
置合わせを手動操作で行う場合、上下方向と左右方向に
フォークを操作する必要があるが、このとき、上下方向
と左右方向のそれぞれの移動方向で位置が合ったら、位
置が合った旨を視覚的に分かる表示態様で示すか、音声
で知らせる方法を採用する。
When the fork is manually aligned as in the third embodiment, it is necessary to operate the fork in the vertical and horizontal directions. At this time, the vertical and horizontal movements are performed. When the positions are matched in the direction, a method of visually indicating that the positions are matched is used or a method of notifying by voice is adopted.

【0107】○ 第2及び第3の実施形態において、カ
メラ24をインナマスト93に昇降可能に設けてもよ
い。すなわち、カメラ24とフォーク2との相対位置関
係において、第1の実施形態における格納位置と下降位
置に相当する二位置を昇降可能にカメラ24をインナマ
スト93のビームに取り付ける。荷取作業時には格納位
置に配置されたカメラ24で撮影し、荷置作業時には下
降位置に配置されたカメラ24で撮影する。
In the second and third embodiments, the camera 24 may be provided on the inner mast 93 so as to be vertically movable. That is, in the relative positional relationship between the camera 24 and the fork 2, the camera 24 is attached to the beam of the inner mast 93 so as to be able to move up and down in two positions corresponding to the retracted position and the retracted position in the first embodiment. The image is taken by the camera 24 arranged at the storage position during the loading operation and by the camera 24 arranged at the descending position during the loading operation.

【0108】○ 荷役対象の位置情報を得る検出手段
は、カメラの撮影画像データの画像処理によるものに限
定されない。例えば超音波センサ、近接センサ、レーザ
ー式センサなどを使用してその検出値から荷役対象の位
置を測長し、ずれ量または移動目標点を計算する方法を
採用することもできる。この場合、荷役対象に被検出対
象としてのマークを付すことにし、このマークの移動目
標点を移動目標点マークの描画位置として採用すること
もできる。また画像処理以外のセンサによる位置検出方
法を採用する場合、カメラは併存させてもよいし廃止し
てもよい。例えばカメラを廃止した場合は、表示装置の
画面にXYZ方向の数値だけ表示させたり、荷役対象と
移動目標点の位置関係が分かるマークのみ描画させるこ
ともできる。またカメラがある場合も、撮影画像は荷役
対象の位置検出のみに用い、同様に画面には数値のみ、
またはマークのみの描画を行うのみであってもよい。
The detecting means for obtaining the position information of the cargo handling object is not limited to the one based on the image processing of the captured image data of the camera. For example, a method of measuring the position of the cargo handling target from the detected value using an ultrasonic sensor, a proximity sensor, a laser sensor, etc., and calculating the shift amount or the movement target point can also be adopted. In this case, the cargo handling target may be marked with the mark as the detected target, and the movement target point of this mark may be adopted as the drawing position of the movement target point mark. When a position detection method using a sensor other than image processing is adopted, the cameras may be coexisting or may be abolished. For example, when the camera is abolished, it is possible to display only the numerical values in the XYZ directions on the screen of the display device or to draw only the mark that shows the positional relationship between the cargo handling target and the movement target point. Also, even if there is a camera, the captured image is used only for detecting the position of the cargo handling object, similarly, only the numerical value is displayed on the screen,
Alternatively, only the mark may be drawn.

【0109】○ 前記各実施形態ではフォーク位置決め
支援の仕方として荷役対象に付されたマークMと移動目
標点マーク87を画面上で一致させるようにした。これ
に対し、撮影されたマークに替え、現在のフォーク位置
を示すマークを画面上の適宜な位置に描画し、このマー
クに対する移動目標点に別のマークを描画することで、
2つの描画マークの位置関係からフォークの位置決めを
支援する方法を採用することもできる。
In each of the above-described embodiments, the mark M attached to the object of cargo handling and the movement target point mark 87 are made to coincide on the screen as a method of assisting fork positioning. On the other hand, instead of the photographed mark, a mark indicating the current fork position is drawn at an appropriate position on the screen, and another mark is drawn at the movement target point for this mark,
It is also possible to adopt a method of assisting the positioning of the fork based on the positional relationship between the two drawing marks.

【0110】○ 前記各実施形態では、3方向(XYZ
方向)のずれ量(移動距離)を表示したが、YZ方向の
み、Z方向のみを表示するだけとしてもよい。 ○ フォーク(荷役機器)が車幅方向に移動可能に設け
られた産業車両に限定されない。例えばサイドシフト機
能を備えないフォークリフトに適用することもできる。
In each of the above embodiments, three directions (XYZ
Although the shift amount (movement distance) of the (direction) is displayed, only the YZ direction or only the Z direction may be displayed. ○ It is not limited to an industrial vehicle in which a fork (cargo handling equipment) is provided so as to be movable in the vehicle width direction. For example, it can be applied to a forklift without a side shift function.

【0111】○ 荷役機器はフォークに限定されない。
フォーク以外のアタッチメントでもよい。また荷を把持
するクランプ装置、荷をすくうバケットでもよい。さら
に荷を磁着によって把持する荷役機器でもよい。
The cargo handling device is not limited to the fork.
Attachments other than forks may be used. A clamp device for gripping a load or a bucket for scooping the load may be used. Further, a cargo handling device that grips a load by magnetic attachment may be used.

【0112】○ 産業車両はリーチ型フォークリフトに
限定されない。カウンタバランス型フォークリフトでも
よい。また産業車両はフォークリフトに限定されない。
例えばパワーショベルでもよい。なお荷役作業の対象と
される荷は、パレットやパレットで取り扱われる荷物に
限定されず、丸太、ロール紙、コンテナ、土砂等の流動
物など産業車両が作業で扱う対象であればよい。またパ
レット以外の荷載置用部材や荷収容箱をも含む。
The industrial vehicle is not limited to the reach type forklift. A counterbalanced forklift may be used. Further, industrial vehicles are not limited to forklifts.
For example, a power shovel may be used. The cargo to be handled by the cargo handling work is not limited to the pallet or the cargo handled by the pallet, but may be any object such as logs, roll paper, containers, and fluid such as earth and sand that the industrial vehicle handles. It also includes load-carrying members other than pallets and load storage boxes.

【0113】前記実施形態及び別例等から把握される技
術的思想を、以下に記載する。 (1)請求項11又は12の発明において、前記マスト
は、多数段の構成部材がスライドすることで伸縮すると
ともに、前記荷役機器が前記構成部材のうちインナマス
トの最上段に移動配置された後、前記マストがはじめて
スライド伸長する機構を有するテレスコピック型の多段
式マストであって、前記カメラは前記インナマストに固
定されている。
The technical idea understood from the above embodiment and other examples will be described below. (1) In the invention of claim 11 or 12, the mast expands and contracts by sliding a multi-stage component member, and the cargo handling equipment is moved and arranged at the uppermost stage of the inner mast among the component members. The mast is a telescopic type multi-stage mast having a mechanism for sliding and extending for the first time, and the camera is fixed to the inner mast.

【0114】(2)前記技術的思想(1)において、前
記カメラは、前記インナマストのビームに固定された状
態で、前記荷役機器の幅方向略中央に相当する位置に配
置されている。
(2) In the above technical concept (1), the camera is arranged at a position corresponding to approximately the center in the width direction of the cargo handling device in a state of being fixed to the beam of the inner mast.

【0115】(3)請求項1〜12のいずれかにおい
て、前記荷役対象には位置合わせの基準とする基準マー
クが付されており、前記演算手段は、前記荷役機器を荷
役対象に位置合わせするときの前記表示手段の画面上に
おける前記基準マークの移動目標点を位置演算するもの
で、前記描画制御手段は、前記画面の画像上に前記基準
マークの前記移動目標点を指し示す目印を描画すること
を特徴とする。なお、前記各実施形態では、被画像認識
対象であるマークM1,M2が、ここでいう基準マーク
を兼ねている。この構成によれば、画面上において基準
マークが移動目標点の目印に一致するように荷役機器を
移動させれば、画面を見ながら荷役機器が荷役対象に位
置合わせされたことを確認できる。
(3) In any one of claims 1 to 12, the cargo handling target is provided with a reference mark as a reference for alignment, and the computing means aligns the cargo handling equipment with the cargo handling target. At this time, the moving target point of the reference mark on the screen of the display means is position-calculated, and the drawing control means draws a mark indicating the moving target point of the reference mark on the image of the screen. Is characterized by. In each of the above-described embodiments, the marks M1 and M2, which are the image recognition targets, also serve as the reference marks. According to this configuration, if the cargo handling equipment is moved so that the reference mark matches the mark of the movement target point on the screen, it is possible to confirm that the cargo handling equipment is aligned with the cargo handling target while looking at the screen.

【0116】(4)請求項12において、前記被画像認
識対象は前記荷役対象に位置を割り出すために付された
マークである。 (5)請求項7〜13及び前記技術的思想(4)におい
て、前記画像認識手段は、前記荷役対象の位置を特定す
るために付されたマークを前記撮影手段により撮影され
た画像データを基に画像認識して画面上における該マー
クの位置を割り出すものであって、前記演算手段は、前
記画像認識手段により割り出された前記マークの位置デ
ータを基に、前記荷役機器を荷役対象に位置合わせする
ときの前記表示手段の画面上における前記マークの移動
目標点を位置演算するもので、前記描画制御手段は、前
記画面の画像上に前記マークの前記移動目標点を指し示
す目印を描画することを特徴とする。
(4) In claim 12, the image recognition target is a mark attached to the cargo handling target to determine its position. (5) In Claims 7 to 13 and the above-mentioned technical idea (4), the image recognition means is based on image data captured by the imaging means with a mark attached to identify the position of the cargo handling target. Image recognition is performed to determine the position of the mark on the screen, and the calculating means positions the cargo handling equipment as a cargo handling target based on the position data of the mark calculated by the image recognition means. The position of the moving target point of the mark on the screen of the display means at the time of alignment is calculated, and the drawing control means draws a mark indicating the moving target point of the mark on the image of the screen. Is characterized by.

【0117】(6)請求項1〜13及び技術的思想
(1)〜(5)のいずれかにおいて、前記目印は、点対
象の性質を持つ図形からなり、該目印はその点対象の点
が前記移動目標点と一致するように描画される。この構
成によれば、目印として使用される図形の形状から、そ
の目印によって指し示される移動目標点を容易に一点に
特定できる。
(6) In any one of claims 1 to 13 and technical ideas (1) to (5), the mark is a figure having the property of point object, and the mark has a point object point. It is drawn so as to coincide with the movement target point. According to this configuration, the movement target point indicated by the mark can be easily specified as one point from the shape of the graphic used as the mark.

【0118】(7)請求項1〜13及び技術的思想
(1)〜(6)のいずれかにおいて、前記荷役対象と
は、パレット又は棚部である。ここで、棚部とは、棚に
荷を収納する荷役作業時に荷役機器の位置合わせの対象
(基準)となる棚の部分である。
(7) In any one of claims 1 to 13 and technical ideas (1) to (6), the object of cargo handling is a pallet or a shelf. Here, the shelf part is a part of the shelf which is a target (reference) of alignment of the cargo handling equipment during the cargo handling work for storing the load on the shelf.

【0119】[0119]

【発明の効果】以上詳述したように請求項1〜14に記
載の発明によれば、荷役機器の作業エリア(荷役対象)
を映し出す表示手段の画面の画像上に、荷役機器を位置
合わせするための位置決め情報が表示(描画)されるた
め、画面を通して荷役機器を位置合わせするときの助け
となる。
As described above in detail, according to the invention described in claims 1 to 14, the work area of the cargo handling equipment (the cargo handling target)
Since the positioning information for aligning the cargo handling equipment is displayed (drawn) on the image of the screen of the display means that displays the information, it is helpful when aligning the cargo handling equipment through the screen.

【図面の簡単な説明】[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 plan view of an operation lever.

【図3】 棚に対する荷役作業の様子を示す斜視図。FIG. 3 is a perspective view showing a state of cargo handling work on a shelf.

【図4】 荷役操作支援装置の電気的構成を示すブロッ
ク図。
FIG. 4 is a block diagram showing an electrical configuration of a cargo handling operation support device.

【図5】 マークとテンプレートを示す正面図。FIG. 5 is a front view showing a mark and a template.

【図6】 (a)画面座標系を説明する画面図、(b)
マッチング方法の説明図。
6A is a screen diagram illustrating a screen coordinate system, and FIG. 6B is a screen diagram.
Explanatory drawing of a matching method.

【図7】 実座標系を説明する模式斜視図。FIG. 7 is a schematic perspective view illustrating an actual coordinate system.

【図8】 実座標系を説明する平面図。FIG. 8 is a plan view illustrating an actual coordinate system.

【図9】 実座標系と画面座標系との関係を示す相関関
係図。
FIG. 9 is a correlation diagram showing the relationship between the real coordinate system and the screen coordinate system.

【図10】 位置合わせ制御を説明する模式図。FIG. 10 is a schematic diagram illustrating alignment control.

【図11】 位置合わせ制御の処理の流れを示すブロッ
ク図。
FIG. 11 is a block diagram showing a flow of processing of alignment control.

【図12】 描画位置の演算方法を説明する図であり、
(a)は実座標系、(b)は画面座標系をそれぞれ示す
模式図。
FIG. 12 is a diagram illustrating a method of calculating a drawing position,
(A) is a schematic diagram which shows a real coordinate system and (b) shows a screen coordinate system, respectively.

【図13】 位置合わせ制御における画面を示し、
(a)は移動目標点マークが表示された状態の画面図、
(b)は位置合わせ終了時の画面図。
FIG. 13 shows a screen in alignment control,
(A) is a screen diagram in which the movement target point mark is displayed,
(B) is a screen view at the end of alignment.

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

【図15】 カメラがマストに固定された荷役装置の模
式部分正面図。
FIG. 15 is a schematic partial front view of a cargo handling device in which a camera is fixed to a mast.

【図16】 荷役操作支援装置の電気的構成を示すブロ
ック図。
FIG. 16 is a block diagram showing an electrical configuration of a cargo handling operation support device.

【図17】 第3の実施形態における荷役操作支援装置
の電気的構成を示すブロック図。
FIG. 17 is a block diagram showing an electrical configuration of a cargo handling operation support device according to a third embodiment.

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

1…産業車両としてのフォークリフト、2…荷役機器と
してのフォーク、3…車体、11…荷役装置、13…マ
スト、14…キャリッジ、15…駆動手段としてのリフ
トシリンダ、20…荷役作業支援装置としての荷役操作
支援装置、23…撮影手段を構成するカメラユニット、
24…検出手段及び撮影手段を構成するカメラ、28…
表示手段としての表示装置、28A…画面、31…手動
操作手段としての操作レバー(マルチレバー)、40…
棚、41…荷役対象としてのパレット、42…荷役対象
としての棚部、45…制御手段としてのコントローラ、
46…表示制御部、47…判別手段を構成するとともに
制御手段としての荷役制御部、58…揚高検出手段とし
ての揚高センサ、59…判別手段を構成する荷重セン
サ、61…昇降駆動手段としての電動アクチュエータ、
71…駆動手段としてのサイドシフトシリンダ、73…
ストロークセンサ、76…画像処理部、77…描画制御
手段を構成する描画表示部、78…描画制御手段を構成
する描画データ記憶部、81…検出手段及び画像認識手
段を構成する画像認識処理部、82…画像認識手段を構
成するテンプレート記憶部、83…検出手段、画像認識
手段及び演算手段を構成する画像演算部、84…演算手
段としての表示位置決定部、85…相対位置演算手段と
しての相対座標算出部、87…目印としての移動目標点
マーク、93…マストの構成部材としてのインナマス
ト、96…手動操作手段としてのリフトレバー、98…
手動操作手段としてのサイドシフトレバー、M1,M2
…被画像認識対象としてのマーク。
DESCRIPTION OF SYMBOLS 1 ... Forklift as industrial vehicle, 2 ... Fork as cargo handling equipment, 3 ... Car body, 11 ... Cargo handling equipment, 13 ... Mast, 14 ... Carriage, 15 ... Lift cylinder as drive means, 20 ... As cargo handling work support apparatus Cargo handling operation support device 23, a camera unit constituting a photographing means,
24 ... Cameras constituting detecting means and photographing means, 28 ...
Display device as display means, 28A ... Screen, 31 ... Operation lever (multi-lever) as manual operation means, 40 ...
Shelf, 41 ... Pallet as cargo handling target, 42 ... Shelf portion as cargo handling target, 45 ... Controller as control means,
46 ... Display control unit, 47 ... Cargo handling control unit as control unit, as well as cargo handling control unit as control unit, 58 ... Lifting sensor as lifting height detecting unit, 59 ... Load sensor constituting judging unit, 61 ... As lifting drive unit Electric actuator,
71 ... Side shift cylinder as driving means, 73 ...
Stroke sensor, 76 ... Image processing unit, 77 ... Drawing display unit forming drawing control unit, 78 ... Drawing data storage unit forming drawing control unit, 81 ... Image recognition processing unit forming detection unit and image recognition unit, Reference numeral 82 ... Template storage unit constituting image recognition means, 83 ... Detection means, image calculation portion constituting image recognition means and calculation means, 84 ... Display position determination section as calculation means, 85 ... Relative as relative position calculation means Coordinate calculation unit, 87 ... Movement target point mark as mark, 93 ... Inner mast as constituent member of mast, 96 ... Lift lever as manual operation means, 98 ...
Side shift levers M1, M2 as manual operation means
... A mark as an image recognition target.

───────────────────────────────────────────────────── フロントページの続き Fターム(参考) 3F333 AA02 AB13 BA04 BA08 BD02 BE02 CA21 CA24 FA25 FA36 FD03 FD12 FD14 FD15 FE09 5B057 AA16 BA02 DA07 DB02 DB05 DB08 DC32 5C054 AA05 CA04 CC03 CE05 CE12 CF07 FA02 FC12 FC15 FF07 HA26    ─────────────────────────────────────────────────── ─── Continued front page    F-term (reference) 3F333 AA02 AB13 BA04 BA08 BD02                       BE02 CA21 CA24 FA25 FA36                       FD03 FD12 FD14 FD15 FE09                 5B057 AA16 BA02 DA07 DB02 DB05                       DB08 DC32                 5C054 AA05 CA04 CC03 CE05 CE12                       CF07 FA02 FC12 FC15 FF07                       HA26

Claims (14)

【特許請求の範囲】[Claims] 【請求項1】 荷役対象に位置合わせするために車体に
移動可能に設けられた荷役機器と、 表示手段と、 荷役対象の位置を検出する検出手段と、 前記検出手段により検出された位置検出結果を基に前記
荷役機器を前記荷役対象に位置決めする手助けとなる位
置決め情報を前記表示手段に表示する表示制御手段とを
備えた産業車両における荷役作業支援装置。
1. A cargo handling device movably provided on a vehicle body for aligning with a cargo handling target, a display means, a detection means for detecting the position of the cargo handling target, and a position detection result detected by the detection means. A cargo handling work support apparatus for an industrial vehicle, comprising: display control means for displaying positioning information on the display means to help position the cargo handling equipment on the cargo handling target.
【請求項2】 荷役作業をするために車体に移動可能に
設けられた荷役機器と、 前記荷役機器による作業の対象となる荷役対象を撮影す
る撮影手段と、 前記撮影手段により撮影された画像を画面に表示する表
示手段と、 前記撮影手段の撮影エリア内における前記荷役対象の位
置を検出する検出手段と、 前記検出手段により検出された位置データを基に、前記
荷役機器を荷役対象に位置合わせするときの位置決め情
報を演算する演算手段と、 前記表示手段の画面に前記荷役機器を荷役対象に位置決
めする際の位置決め情報を描画する描画制御手段とを備
えた産業車両における荷役作業支援装置。
2. A cargo-handling device movably provided on a vehicle body for carrying out cargo-handling work, a photographing means for photographing a cargo-handling target to be a work target of the cargo-handling equipment, and an image photographed by the photographing means. Display means for displaying on the screen, detection means for detecting the position of the cargo handling target in the photographing area of the photographing means, and the cargo handling device is aligned with the cargo handling subject based on the position data detected by the detecting means. A cargo handling work support apparatus for an industrial vehicle, comprising: a computing unit that computes positioning information when performing the above-described operation; and a drawing control unit that draws positioning information when positioning the cargo handling device on a cargo handling target on a screen of the display unit.
【請求項3】 荷役作業をするために車体に移動可能に
設けられた荷役機器と、 前記荷役機器による作業の対象となる荷役対象を撮影す
る撮影手段と、 前記撮影手段により撮影された画像を画面に表示する表
示手段と、 前記撮影手段により撮影された画像データを画像処理す
ることによって前記画面上における前記荷役対象の位置
を検出する検出手段と、 前記検出手段により検出された位置データを基に、前記
荷役機器を荷役対象に位置合わせするときの前記表示手
段の画面上における移動目標点を位置演算する演算手段
と、 前記画面の画像上に前記移動目標点の位置を報知するた
めの位置決め情報を描画する描画制御手段とを備えた産
業車両における荷役作業支援装置。
3. A cargo-handling device movably provided on a vehicle body for carrying out cargo-handling work, a photographing means for photographing a cargo-handling target to be a work target of the cargo-handling equipment, and an image photographed by the photographing means. Display means for displaying on the screen, detecting means for detecting the position of the cargo handling target on the screen by image processing the image data photographed by the photographing means, and position data detected by the detecting means A calculation means for calculating a position of a movement target point on the screen of the display means when aligning the cargo handling device with a cargo handling target; and positioning for notifying the position of the movement target point on the image of the screen. A cargo handling work support apparatus for an industrial vehicle, comprising: a drawing control means for drawing information.
【請求項4】 前記位置決め情報は、前記荷役機器と荷
役対象との位置関係の情報である請求項1〜3のいずれ
か一項に記載の産業車両における荷役作業支援装置。
4. The cargo handling work support apparatus for an industrial vehicle according to claim 1, wherein the positioning information is information on a positional relationship between the cargo handling equipment and a cargo handling target.
【請求項5】 前記表示手段に表示される前記位置決め
情報は、前記荷役機器と荷役対象との位置関係を方向及
び量で示す文字情報である請求項1〜4のいずれか一項
に記載の産業車両における荷役作業支援装置。
5. The positioning information displayed on the display means is character information indicating a positional relationship between the cargo handling equipment and a cargo handling target in a direction and an amount, according to any one of claims 1 to 4. A cargo handling support device for industrial vehicles.
【請求項6】 荷役作業をするために車体に移動可能に
設けられた荷役機器と、 前記荷役機器による作業の対象となる荷役対象を撮影す
る撮影手段と、 前記撮影手段により撮影された画像を画面に表示する表
示手段と、 前記撮影手段により撮影された画像データを基に前記画
面上における前記荷役対象の位置を検出する検出手段
と、 前記検出手段により検出された位置データを基に、前記
荷役機器を荷役対象に位置合わせするときの前記表示手
段の画面上における移動目標点を位置演算する演算手段
と、 前記画面の画像上に前記移動目標点の位置を視認させる
ための目印を描画する描画制御手段とを備えた産業車両
における荷役作業支援装置。
6. A cargo-handling device movably provided on a vehicle body for carrying out cargo-handling work, a photographing means for photographing a cargo-handling target to be a work target of the cargo-handling equipment, and an image photographed by the photographing means. Display means for displaying on the screen, detection means for detecting the position of the cargo handling target on the screen based on the image data photographed by the photographing means, and based on the position data detected by the detection means, Calculating means for calculating the position of the movement target point on the screen of the display means when aligning the cargo handling equipment with the cargo handling object, and drawing a mark for visually recognizing the position of the movement target point on the image of the screen. A cargo handling work support apparatus for an industrial vehicle, comprising a drawing control means.
【請求項7】 前記検出手段は、前記撮影手段により撮
影された画像データを基に前記画面上における前記荷役
対象の位置を割り出す画像認識処理を行う画像認識手段
である請求項2〜6のいずれか一項に記載の産業車両に
おける荷役作業支援装置。
7. The image recognition means for performing image recognition processing for determining the position of the cargo handling target on the screen based on the image data photographed by the photographing means. Item 1. A cargo handling work support device for an industrial vehicle according to item 1.
【請求項8】 荷役作業をするために車体に移動可能に
設けられた荷役機器と、 前記荷役機器による作業の対象となる荷役対象を撮影す
る撮影手段と、 前記撮影手段により撮影された画像を画面に表示する表
示手段と、 前記表示手段の画面上における前記荷役対象に付された
マークの前記荷役機器を前記荷役対象に位置合わせする
ときの移動目標点を位置演算する演算手段と、 前記画面の画像上に前記移動目標点を視認させるための
目印を描画する描画制御手段とを備えた産業車両におけ
る荷役作業支援装置。
8. A cargo-handling device movably provided on a vehicle body for carrying out cargo-handling work, a photographing means for photographing a cargo-handling target to be a work target of the cargo-handling equipment, and an image photographed by the photographing means. Display means for displaying on a screen, calculating means for position-calculating a movement target point when aligning the cargo handling equipment with a mark attached to the cargo handling target on the screen of the display means, the screen And a drawing control means for drawing a mark for visually recognizing the movement target point on the image of FIG.
【請求項9】 前記荷役機器を移動させる手動操作をす
るための手動操作手段と、前記手動操作手段の手動操作
に応じて前記荷役機器を移動させる駆動手段を制御する
制御手段とを備え、 前記演算手段は、前記手動操作手段の手動操作によって
前記荷役機器を移動させるときの前記表示手段の画面上
における移動目標点を演算する請求項2〜8のいずれか
一項に記載の産業車両における荷役作業支援装置。
9. A manual operation means for performing a manual operation for moving the cargo handling equipment, and a control means for controlling a drive means for moving the cargo handling equipment according to a manual operation of the manual operation means, 9. The cargo handling in the industrial vehicle according to claim 2, wherein the calculation means calculates a movement target point on the screen of the display means when the cargo handling equipment is moved by the manual operation of the manual operation means. Work support device.
【請求項10】 前記撮影手段を構成するカメラは前記
荷役機器に対し昇降可能に設けられ、前記荷役機器によ
る荷役作業が荷取作業か荷置作業であるかを判別する判
別手段と、前記判別手段により判別された荷役作業の種
別に応じた高さに前記カメラを前記荷役機器に対し移動
配置するよう駆動される昇降駆動手段とを備え、荷置作
業時の前記カメラの配置位置は前記荷役機器に取られた
荷によって作業エリアの撮影が妨げられない位置に設定
されている請求項2〜9のいずれか一項に記載の産業車
両における荷役作業支援装置。
10. A discriminating means for discriminating whether a cargo handling operation by the cargo handling equipment is a picking up work or a loading work, and a camera constituting the photographing means is provided so as to be able to move up and down with respect to the cargo handling equipment. And an elevating and lowering drive unit that is driven to move and arrange the camera with respect to the cargo-handling equipment at a height according to the type of the cargo-handling work determined by the means. The cargo handling work support apparatus for an industrial vehicle according to any one of claims 2 to 9, which is set at a position where shooting of a work area is not hindered by a load taken by the device.
【請求項11】 前記撮影手段を構成するカメラは、前
記荷役機器を有するキャリッジが昇降可能に設けられた
マストの構成部材に対し固定され、前記荷役機器が所定
揚高以上の揚高を昇降するときに該荷役機器と前記カメ
ラとが少なくとも高さ方向に一定の位置関係を保ったま
ま前記キャリッジが前記マスト上を移動するように荷役
装置が構成されており、 前記荷役機器の揚高を検出する揚高検出手段を備え、 前記描画制御手段は、前記揚高検出手段により検出され
た揚高が前記所定揚高以上のときに、前記演算手段によ
り演算された移動目標点の位置データを基に前記画面の
画像上に前記移動目標点を視認させるための目印を描画
する処理を実行する請求項2〜10のいずれか一項に記
載の産業車両における荷役作業支援装置。
11. A camera constituting the photographing means is fixed to a component of a mast in which a carriage having the cargo handling equipment is provided so as to be able to move up and down, and the cargo handling equipment moves up and down above a predetermined lifting height. Sometimes, the cargo handling device is configured such that the carriage moves on the mast while maintaining a constant positional relationship between the cargo handling equipment and the camera at least in the height direction, and detects the lift of the cargo handling equipment. When the lift detected by the lift detecting means is equal to or higher than the predetermined lift, the drawing control means is based on the position data of the moving target point calculated by the calculating means. The cargo handling work support device for an industrial vehicle according to any one of claims 2 to 10, which executes a process of drawing a mark for visually recognizing the movement target point on the image of the screen.
【請求項12】 荷役機器を有するキャリッジが車体に
設けられたマストに沿って昇降可能に設けられた産業車
両において、 前記荷役機器の作業エリアを撮影可能に前記マストの構
成部材に設けられたカメラと、 前記カメラにより撮影された画像を画面に表示する表示
手段と、 荷役機器により行われる荷役作業が荷取作業か荷置作業
かを判別する判別手段と、 前記判別手段により判別された荷役作業の種別に応じて
荷役対象を決定し、前記カメラにより撮影された画像デ
ータを基に、当該荷役対象の位置検出用の被画像認識対
象を画像認識処理することにより前記表示手段の画面上
における該荷役対象の位置を検出する検出手段と、 前記荷役機器を前記荷役対象に位置合わせするときの前
記表示手段の画面上における移動目標点を位置演算する
演算手段と、 前記表示手段の画面上における前記移動目標点を視認さ
せる目印を該画面の画像上に描画する描画制御手段とを
備えた産業車両における荷役作業支援装置。
12. An industrial vehicle in which a carriage having a cargo handling device is provided so as to be able to move up and down along a mast provided on a vehicle body, and a camera provided in a component member of the mast capable of photographing a work area of the cargo handling device. A display means for displaying an image taken by the camera on the screen, a discriminating means for discriminating whether the cargo handling work performed by the cargo handling equipment is a unloading work or a loading work, and the cargo handling work judged by the judging means. The object of cargo handling is determined according to the type of the object, and based on the image data taken by the camera, the image recognition target image recognition target for position detection of the object of cargo handling is subjected to image recognition processing, thereby Detecting means for detecting the position of the cargo handling target, and position calculation of the movement target point on the screen of the display means when aligning the cargo handling equipment with the cargo handling target That calculating means and, cargo handling assistance device in an industrial vehicle including a drawing control means for drawing the mark to visually recognize the moving target point on the image of said screen on the screen of the display means.
【請求項13】 前記検出手段は、荷取作業と荷置作業
を区別して荷役対象を位置検出し、前記表示手段には前
記検出手段により位置検出された荷役対象の荷取作業か
荷置作業に応じた位置決め情報が表示される請求項1〜
12のいずれか一項に記載の産業車両における荷役作業
支援装置。
13. The detection means detects the position of the cargo handling object by distinguishing the cargo taking operation and the loading operation, and the display means displays the cargo handling object of the cargo handling object whose position is detected by the detecting means. The positioning information according to is displayed.
Item 12. A cargo handling work support device for an industrial vehicle according to any one of items 12.
【請求項14】 請求項1〜13のいずれか一項に記載
の荷役作業支援装置を備えている産業車両。
14. An industrial vehicle provided with the cargo handling work support apparatus according to claim 1.
JP2001352369A 2001-07-17 2001-11-16 Cargo work support device for industrial vehicle and industrial vehicle Expired - Lifetime JP3900902B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2001352369A JP3900902B2 (en) 2001-11-16 2001-11-16 Cargo work support device for industrial vehicle and industrial vehicle
US10/470,491 US7219769B2 (en) 2001-07-17 2002-02-18 Industrial vehicle equipped with load handling operation control apparatus
PCT/JP2002/001353 WO2003008325A1 (en) 2001-07-17 2002-02-18 Industrial vehicle equipped with material handling work controller
EP02712415.5A EP1408001B1 (en) 2001-07-17 2002-02-18 Industrial vehicle equipped with material handling work controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2001352369A JP3900902B2 (en) 2001-11-16 2001-11-16 Cargo work support device for industrial vehicle and industrial vehicle

Publications (2)

Publication Number Publication Date
JP2003155198A true JP2003155198A (en) 2003-05-27
JP3900902B2 JP3900902B2 (en) 2007-04-04

Family

ID=19164557

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2001352369A Expired - Lifetime JP3900902B2 (en) 2001-07-17 2001-11-16 Cargo work support device for industrial vehicle and industrial vehicle

Country Status (1)

Country Link
JP (1) JP3900902B2 (en)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020095602A1 (en) * 2018-11-05 2020-05-14 株式会社豊田自動織機 Remote operating system for forklift
CN111469564A (en) * 2019-01-23 2020-07-31 精工爱普生株式会社 Auxiliary member and printing apparatus
WO2021075438A1 (en) * 2019-10-18 2021-04-22 株式会社豊田自動織機 Operation assistance device for cargo-handling vehicle
CN113148908A (en) * 2021-03-16 2021-07-23 李亚军 Automatic forklift mechanical steering system and method

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2020095602A1 (en) * 2018-11-05 2020-05-14 株式会社豊田自動織機 Remote operating system for forklift
CN111469564A (en) * 2019-01-23 2020-07-31 精工爱普生株式会社 Auxiliary member and printing apparatus
US10906338B2 (en) 2019-01-23 2021-02-02 Seiko Epson Corporation Auxiliary member and printing apparatus
CN111469564B (en) * 2019-01-23 2022-08-26 精工爱普生株式会社 Auxiliary member and printing apparatus
WO2021075438A1 (en) * 2019-10-18 2021-04-22 株式会社豊田自動織機 Operation assistance device for cargo-handling vehicle
JP2021066540A (en) * 2019-10-18 2021-04-30 株式会社豊田自動織機 Operation support device of cargo handling vehicle
JP7268575B2 (en) 2019-10-18 2023-05-08 株式会社豊田自動織機 Operation support device for cargo handling vehicle
CN113148908A (en) * 2021-03-16 2021-07-23 李亚军 Automatic forklift mechanical steering system and method

Also Published As

Publication number Publication date
JP3900902B2 (en) 2007-04-04

Similar Documents

Publication Publication Date Title
US7010404B2 (en) Position control apparatus and position control method for cargo carrying apparatus in industrial vehicle
US7219769B2 (en) Industrial vehicle equipped with load handling operation control apparatus
JP3921968B2 (en) Position detection method and position detection apparatus
EP1361190B1 (en) Camera lifting device and load handling support device of industrial vehicle, and industrial vehicle
WO2016181733A1 (en) Forklift
JP2003171094A (en) Industrial vehicle handle knob and industrial vehicle
JP4882176B2 (en) Cargo handling support notification device and industrial vehicle in industrial vehicle
JP2013086959A (en) Support device and method for positioning fork of forklift
JP6858104B2 (en) Information processing device and information processing method
US20220332249A1 (en) System and method providing visual aids for workpiece manipulator positioning and movement preview path
JP3900942B2 (en) Automatic position control device for cargo handling equipment in industrial vehicles, industrial vehicle and automatic position control method for cargo handling equipment
JP2020029361A (en) Cargo handling work supporting device for fork lift
JP3858703B2 (en) Cargo work support device for industrial vehicle and industrial vehicle
JP3900902B2 (en) Cargo work support device for industrial vehicle and industrial vehicle
WO2021075541A1 (en) Cargo handling work assistance device for cargo handling vehicle
JP4961643B2 (en) Cargo handling control device and industrial vehicle in industrial vehicle
JP2003128395A (en) Cargo handling work support device in industrial vehicle and industrial vehicle
JP2003155199A (en) Voice annunciator for industrial vehicle and industrial vehicle
JP3941521B2 (en) Industrial vehicle sign selection device and industrial vehicle
WO2020095602A1 (en) Remote operating system for forklift
WO2020085068A1 (en) Remote control system for forklift
JP3900887B2 (en) Industrial vehicle work mode switching device and industrial vehicle
JP7087737B2 (en) Remote control system for forklifts
JP2003089500A (en) Loading lever and industrial vehicle
JP2021042071A (en) Side shift device control device for forklift

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20040318

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20060822

A521 Written amendment

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20061016

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20061225

R151 Written notification of patent or utility model registration

Ref document number: 3900902

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

Year of fee payment: 3

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

Free format text: PAYMENT UNTIL: 20110112

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20110112

Year of fee payment: 4

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

Free format text: PAYMENT UNTIL: 20120112

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20120112

Year of fee payment: 5

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

Free format text: PAYMENT UNTIL: 20130112

Year of fee payment: 6

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

Free format text: PAYMENT UNTIL: 20140112

Year of fee payment: 7

EXPY Cancellation because of completion of term