JPH0255002B2 - - Google Patents
Info
- Publication number
- JPH0255002B2 JPH0255002B2 JP57205136A JP20513682A JPH0255002B2 JP H0255002 B2 JPH0255002 B2 JP H0255002B2 JP 57205136 A JP57205136 A JP 57205136A JP 20513682 A JP20513682 A JP 20513682A JP H0255002 B2 JPH0255002 B2 JP H0255002B2
- Authority
- JP
- Japan
- Prior art keywords
- arm
- fruit
- target
- hand
- imaging means
- 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.)
- Expired - Lifetime
Links
Landscapes
- Control Of Position Or Direction (AREA)
- Harvesting Machines For Specific Crops (AREA)
- Numerical Control (AREA)
Description
【発明の詳細な説明】
本発明は収穫装置に関し、特にみかんやりんご
等の果実を収穫できる様にマニピユレーターを応
用した収穫装置に関する。DETAILED DESCRIPTION OF THE INVENTION The present invention relates to a harvesting device, and particularly to a harvesting device to which a manipulator is applied so as to be able to harvest fruits such as tangerines and apples.
果実等の収穫作業は機械化が進んでいない現状
に鑑みて、本出願人は先願等に於いてマニピユレ
ーターを応用した果実収穫装置を既に提案してい
るが、これらの装置では一般的な工業用マニピユ
レーターを用いて従来から行われているのと同様
に目標物の座標を与えることによつて、摘み取り
部であるハンドを目標物に接近移動させるべく構
成されていた。 In view of the current situation where mechanization of fruit harvesting work has not progressed, the applicant has already proposed a fruit harvesting device using a manipulator in a previous application, etc. The hand, which is the picking section, is moved closer to the target object by giving the coordinates of the target object in the same manner as conventionally done using an industrial manipulator.
しかるに、果実等の収穫装置としてマニピユレ
ーターを応用する場合に、この様な手段を用いる
には三次元空間に不規則に散在する果実等の目標
物の位置座標を三角測量や測距によつて検出しな
ければならず、検出装置の構成が複雑なものとな
る。又、検出装置によつて検出された目標物の位
置とハンドの位置とを比較しながら目標物に対す
るハンドのアプローチを行うため、ハンドの誘導
制御も複雑なものとなる。 However, when using a manipulator as a device for harvesting fruits, etc., it is necessary to use triangulation or distance measurement to determine the position coordinates of objects such as fruits that are irregularly scattered in a three-dimensional space. Therefore, the configuration of the detection device becomes complicated. Further, since the hand approaches the target while comparing the position of the target detected by the detection device with the position of the hand, the guidance and control of the hand becomes complicated.
また、産業用ロボツトにおいて目標物に対する
位置決めを行う構成として特開昭48−93063号公
報に開示されているものがある。 Furthermore, Japanese Patent Laid-Open No. 48-93063 discloses a configuration for positioning an industrial robot with respect to a target.
つまり、光学的位置検出器に複数の光電変換素
子を備え、夫々の光電変換素子に入射する目標物
からの反射光量の差に基づいて、ロボツトハンド
の位置決めを行うようになつている。 That is, the optical position detector is equipped with a plurality of photoelectric conversion elements, and the robot hand is positioned based on the difference in the amount of light reflected from the target object that is incident on each photoelectric conversion element.
しかしながら、上記構成では、反射光量を利用
するものであるので外乱光の影響を受けやすく屋
外での使用や目標物までの距離が遠い場合には適
さないものとなる。従つて、果実等の収穫装置に
は適用しにくいものであつた。 However, since the above configuration utilizes the amount of reflected light, it is susceptible to disturbance light and is not suitable for outdoor use or when the distance to the target is long. Therefore, it is difficult to apply it to a device for harvesting fruits, etc.
本発明の目的は、上記従来欠点を解消して目標
物を検出し、且つ、その目標物へハンドを誘導す
る構成を簡素化する点にある。 SUMMARY OF THE INVENTION An object of the present invention is to eliminate the above-mentioned conventional drawbacks and simplify the configuration for detecting a target object and guiding a hand to the target object.
この目的を達成するため、本発明による収穫装
置の特徴構成は、先端に果実摘取用のハンドが設
けられた伸縮自在なアームが、基台に対して水平
方向に旋回自在で、且つ、前記アームの伸縮方向
と水平面とのなす仰角を変更自在に設けられ、目
標物を捕らえる撮像手段が、その光軸を前記伸縮
方向に固定して前記アームに取り付けられ、その
撮像手段が目標物を画面の中央部で捕らえたこと
が検出されるに伴つて前記アームの伸長運動を行
わせる信号を発する制御部を有することである。 In order to achieve this object, the harvesting device according to the present invention has a characteristic configuration in which a telescoping arm having a fruit-picking hand at its tip is pivotable in the horizontal direction with respect to the base; Imaging means is provided to be able to freely change the angle of elevation between the extension direction of the arm and the horizontal plane, and is attached to the arm with its optical axis fixed in the extension direction, and the imaging means captures the target object on the screen. The invention further includes a control section that emits a signal for causing the arm to extend when it is detected that the arm has been captured at the center of the arm.
アームを水平方向に旋回させ、又、仰角を変更
させることにより撮像手段の光軸を任意の方向に
向けることができる。つまり、撮像手段の光軸を
三次元空間に散在する任意の目標物に向けること
ができる。前記光軸とアームの伸縮方向は一致し
ているので、目標物を画面の中央部で捕らえた状
態でアームを伸長させることにより、ハンドを正
確に目標物に誘導することができる。 By rotating the arm in the horizontal direction and changing the elevation angle, the optical axis of the imaging means can be directed in any direction. In other words, the optical axis of the imaging means can be directed to arbitrary targets scattered in three-dimensional space. Since the optical axis and the direction of extension and contraction of the arm coincide, the hand can be accurately guided to the target by extending the arm while capturing the target at the center of the screen.
従つて、三次元空間に散在する目標物を検出
し、且つ、その目標物へハンドを誘導する装置の
構成を簡素化して、作業性の高い収穫装置を得る
ことができる。 Therefore, the configuration of the device that detects target objects scattered in a three-dimensional space and guides the hand to the target objects can be simplified, and a harvesting device with high operability can be obtained.
以下、本発明の実施例について図面に基づいて
説明する。 Embodiments of the present invention will be described below based on the drawings.
第1図に示すように、アーム2が、基台1に対
して第1軸芯A及び第2軸芯B周りに矢印a,b
で示すように揺動自在で、且つ、矢印cで示す方
向に伸縮自在に構成されている。 As shown in FIG.
It is configured to be able to swing freely as shown by and extend and contract in the direction shown by arrow c.
すなわち、アーム2が、基台1に対して水平方
向に旋回自在で、且つ、前記アーム2の伸縮方向
と水平面とのなす仰角を変更自在に設けられてい
る。 That is, the arm 2 is provided so as to be able to freely pivot in the horizontal direction with respect to the base 1, and to change the elevation angle between the extension/contraction direction of the arm 2 and the horizontal plane.
アーム2の先端には果実摘取用のハンド3が取
り付けられていて、このハンド3の指4…には接
触センサー(図示せず)が設けられていて目標物
に接触することで目標物に到達したことを検出で
きる様に構成されている。5は摘み取つた果実を
収納部(図示せず)に搬送するためのシユーター
である。 A hand 3 for picking fruit is attached to the tip of the arm 2, and the fingers 4 of this hand 3 are equipped with contact sensors (not shown), so that when they come into contact with a target object, the hand 3 picks the fruit. It is configured so that it can detect that it has arrived. 5 is a shooter for conveying the picked fruit to a storage section (not shown).
アーム2の矢端部に撮像手段としてのテレビカ
メラ6がその光軸Pをアーム2の伸縮方向に固定
して取り付けられ、アーム2を前記軸芯A,Bの
周りに揺動させることによつて目標物である果実
を画面上に捕らえることが可能に構成されてい
る。 A television camera 6 as an imaging means is attached to the arrow end of the arm 2 with its optical axis P fixed in the direction of expansion and contraction of the arm 2, and by swinging the arm 2 around the axes A and B. The structure is such that the target fruit can be captured on the screen.
次に、第2図に示すフローチヤートに基づいて
ハンド3を果実に接近させる方法について説明す
る。 Next, a method of bringing the hand 3 closer to the fruit will be explained based on the flowchart shown in FIG.
先ず、アーム2を所定のプログラムに従つて軸
芯A,Bの周りに揺動運動を行わせながらテレビ
カメラ6に撮像された画像を処理して画面上に果
実を捕らえたことを検出する。果実の認識は、果
実の色に対応した特定色の分布状態によつて行
う。ここで、画面の横軸座標をX軸、縦軸座標を
Y軸とし、画面の中央における両座標を0とす
る。 First, the arm 2 is rocked around the axes A and B according to a predetermined program, and the image taken by the television camera 6 is processed to detect that a fruit has been captured on the screen. Fruits are recognized based on the distribution of specific colors corresponding to the fruit colors. Here, the horizontal axis coordinate of the screen is the X axis, the vertical axis coordinate is the Y axis, and both coordinates at the center of the screen are 0.
第3図イに示すように、テレビカメラ6の画面
内に果実が入るとその果実の座標を検出し、X軸
座標がずれている場合には所定角度αづつ軸芯B
周りにアーム2を揺動させ、又、Y軸座標がずれ
ている場合には所定角度βづつ軸芯A周りにアー
ム2を揺動させる。 As shown in FIG. 3A, when a fruit enters the screen of the TV camera 6, the coordinates of the fruit are detected, and if the X-axis coordinate is shifted, the axis B is moved by a predetermined angle α
The arm 2 is swung around the axis A, and when the Y-axis coordinate is deviated, the arm 2 is swung around the axis A by a predetermined angle β.
そして、第3図ロに示すように、両座標がほぼ
0となるまで上述の補正を繰り返す。果実が画面
の中央に至ると揺動運動を停止し、アーム2を伸
長させるのである(第3図ハ参照)。そして、ハ
ンド3が果実に至つたことが前記接触センサによ
つて検出されたときには、ハンド3に所定の動作
をさせて果実を摘み取るのである。 Then, as shown in FIG. 3B, the above-described correction is repeated until both coordinates become approximately 0. When the fruit reaches the center of the screen, the swinging motion is stopped and the arm 2 is extended (see Figure 3, c). When the contact sensor detects that the hand 3 has reached the fruit, the hand 3 is caused to perform a predetermined action to pick the fruit.
図面は本発明に係る収穫装置の実施例を示し、
第1図は全体斜視図、第2図は制御方法を示すフ
ローチヤート、そして、第3図は画像の変化を示
す図である。
1…基台、2…アーム、3…ハンド、6…撮像
手段。
The drawings show an embodiment of the harvesting device according to the invention,
FIG. 1 is an overall perspective view, FIG. 2 is a flowchart showing a control method, and FIG. 3 is a diagram showing changes in images. 1...Base, 2...Arm, 3...Hand, 6...Imaging means.
Claims (1)
縮自在なアーム2が、基台1に対して水平方向に
旋回自在で、且つ、前記アーム2の伸縮方向と水
平面とのなす仰角を変更自在に設けられ、目標物
を捕らえる撮像手段6が、その光軸Pを前記伸縮
方向に固定して前記アーム2に取り付けられ、そ
の撮像手段6が目標物の画面の中央部で捕らえた
ことを検出されるに伴つて前記アーム2の伸長運
動を行わせる信号を発する制御部を有する収穫装
置。1. A telescoping arm 2 with a fruit-picking hand 3 provided at its tip is capable of pivoting horizontally with respect to the base 1, and changes the angle of elevation between the telescoping direction of the arm 2 and the horizontal plane. An imaging means 6 that is freely provided and captures a target is attached to the arm 2 with its optical axis P fixed in the expansion and contraction direction, and the imaging means 6 captures the target at the center of the screen. A harvesting device comprising a control unit that emits a signal that causes the arm 2 to perform an extension movement when detected.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP20513682A JPS5995809A (en) | 1982-11-22 | 1982-11-22 | Harvesting apparatus |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP20513682A JPS5995809A (en) | 1982-11-22 | 1982-11-22 | Harvesting apparatus |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| JPS5995809A JPS5995809A (en) | 1984-06-02 |
| JPH0255002B2 true JPH0255002B2 (en) | 1990-11-26 |
Family
ID=16502015
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| JP20513682A Granted JPS5995809A (en) | 1982-11-22 | 1982-11-22 | Harvesting apparatus |
Country Status (1)
| Country | Link |
|---|---|
| JP (1) | JPS5995809A (en) |
Families Citing this family (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS6147112A (en) * | 1984-08-10 | 1986-03-07 | 株式会社クボタ | Fruit harvester |
| JPS61124315A (en) * | 1984-11-20 | 1986-06-12 | 株式会社クボタ | work equipment |
| JPH0697907B2 (en) * | 1985-10-17 | 1994-12-07 | 株式会社クボタ | Fruit and vegetable harvesting equipment |
| JPH0350211U (en) * | 1989-09-14 | 1991-05-16 | ||
| JP2016203289A (en) * | 2015-04-20 | 2016-12-08 | 三井屋工業株式会社 | Robot arm |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPS48100853U (en) * | 1972-02-29 | 1973-11-28 | ||
| JPS4893063A (en) * | 1972-03-11 | 1973-12-01 | ||
| JPS5423545A (en) * | 1977-07-22 | 1979-02-22 | Mitsubishi Paper Mills Ltd | Heat sensitive paper with reduced adherability of dregs to thermal head |
-
1982
- 1982-11-22 JP JP20513682A patent/JPS5995809A/en active Granted
Also Published As
| Publication number | Publication date |
|---|---|
| JPS5995809A (en) | 1984-06-02 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR970007039B1 (en) | Detection position correction method | |
| JPH0428518B2 (en) | ||
| USRE38025E1 (en) | High precision component alignment sensor system | |
| US6095928A (en) | Three-dimensional object path tracking | |
| US9113154B2 (en) | Three-dimensional measurement device having three-dimensional overview camera | |
| JPH0798208A (en) | Method and system for recognizing three-dimensional position and attitude on the basis of sense of sight | |
| JPH0425583B2 (en) | ||
| KR19990081876A (en) | Distance and positioning devices | |
| JPH0255002B2 (en) | ||
| US20150378022A1 (en) | Method and system for providing a mobile device with information on the position thereof relative to a target, robot integrating such a system and tablet | |
| JP2953116B2 (en) | Wire bonding equipment | |
| KR102292561B1 (en) | Calibration Device and Calibration System including the same | |
| Armstrong et al. | RGR-3D: simple, cheap detection of 6-DOF pose for teleoperation, and robot programming and calibration | |
| JP3923168B2 (en) | Component recognition method and component mounting method | |
| CN112219088B (en) | Rotatable and movable robot for mapping an area and method for mapping an area | |
| JP3229024B2 (en) | 3D position locating device | |
| JPH0666519A (en) | Correlation detecting type measuring apparatus for three-dimensional position | |
| KR0167585B1 (en) | Position recognizing method | |
| HU210376B (en) | Fruit-picking apparatus and method for looking for fruits | |
| JPH069795B2 (en) | Robot wrist positioning method | |
| JPH0124561Y2 (en) | ||
| JP2508916B2 (en) | Tracking distance measuring device | |
| JP2526543B2 (en) | Object height measuring device | |
| JPH0697162B2 (en) | Distance measurement method for three-dimensional objects | |
| JPS58143204A (en) | Device for measuring surface shape |