JPH1033079A - Automatic milking machine - Google Patents

Automatic milking machine

Info

Publication number
JPH1033079A
JPH1033079A JP8197732A JP19773296A JPH1033079A JP H1033079 A JPH1033079 A JP H1033079A JP 8197732 A JP8197732 A JP 8197732A JP 19773296 A JP19773296 A JP 19773296A JP H1033079 A JPH1033079 A JP H1033079A
Authority
JP
Japan
Prior art keywords
unit
end effector
direction displacement
automatic milking
displacement
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.)
Pending
Application number
JP8197732A
Other languages
Japanese (ja)
Inventor
Naotake Nishizawa
尚武 西澤
Eiichi Iwasaki
栄一 岩崎
Tetsuo Ota
哲郎 太田
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.)
M EE T KK
Orion Machinery Co Ltd
Komatsu Engineering Corp
Original Assignee
M EE T KK
Orion Machinery Co Ltd
Komatsu Engineering 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 M EE T KK, Orion Machinery Co Ltd, Komatsu Engineering Corp filed Critical M EE T KK
Priority to JP8197732A priority Critical patent/JPH1033079A/en
Publication of JPH1033079A publication Critical patent/JPH1033079A/en
Pending legal-status Critical Current

Links

Landscapes

  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To provide an automatic milking machine simplified in the structure, enabling to milk at a high speed and improved in profitability, safety, durability and reliability by disposing a displacement-driving mechanism section connected to an X-direction displacement part, etc., corresponding to a driving section through a transmission section for remote control. SOLUTION: A displacement mechanism section 5a having an X-direction displacement part 5ax, a Y-direction displacement part 5ay and a Z-direction displacement part 5az supporting a teat cup Ta in a state capable of being displaced in the X, Y and Z-direction is disposed in an end effector 2. Driving parts 6ax, 6at and 6az corresponding to all (or a part) of the X-direction displacement part 5ax, the Y-direction displacement part 5ay and the Z-direction displacement part 5az are disposed in a site except the end effector 2. A displacement-driving mechanism section 4a connected to all (or a part) of the X-direction displacement part 5ax, the Y-direction displacement part 5ay and the Z-direction displacement part 5az corresponding to the driving parts 6ax, 6ay and 6az through transmission parts 7az, 7ay and 7az for remote control is also disposed.

Description

【発明の詳細な説明】DETAILED DESCRIPTION OF THE INVENTION

【0001】[0001]

【発明の属する技術分野】本発明は乳頭にティートカッ
プを自動で装着する搾乳ロボットを備える自動搾乳機に
関する。
BACKGROUND OF THE INVENTION 1. Field of the Invention The present invention relates to an automatic milking machine having a milking robot for automatically mounting a teat cup on a teat.

【0002】[0002]

【従来の技術】従来、乳頭にティートカップを自動で装
着する搾乳ロボットを備える自動搾乳機としては、ヨー
ロッパ特許No.300115A1公報等で開示される
自動搾乳機が知られている。
2. Description of the Related Art Conventionally, as an automatic milking machine having a milking robot for automatically attaching a teat cup to a teat, European Patent No. An automatic milking machine disclosed in 300115A1 and the like is known.

【0003】ところで、この種の自動搾乳機はX方向,
Y方向及びZ方向に移動する移動機構を備え、乳頭位置
検出装置により乳頭の位置を検出するとともに、移動機
構により、四つのティートカップを一つずつ順番に乳頭
に装着するため、四つのティートカップを全て装着する
には相当の時間がかかり、効率面で極めて不利になる難
点があった。
[0003] By the way, this kind of automatic milking machine is used in the X direction,
A moving mechanism that moves in the Y direction and the Z direction is provided. The teat position detecting device detects the position of the teat, and the moving mechanism mounts the four teat cups one by one on the teat one by one. It takes a considerable amount of time to attach all of them, and there is a disadvantage that efficiency is extremely disadvantageous.

【0004】このため、装着時間の短縮と効率アップを
図れるように、ロボット機能を各ティートカップ毎に個
別に設けることにより、四つのティートカップを同時に
装着できるようにした自動搾乳機も、米国特許第527
9253号公報等で知られている。
[0004] For this reason, an automatic milking machine in which four teat cups can be simultaneously mounted by separately providing a robot function for each teat cup so as to shorten the mounting time and increase the efficiency is also disclosed in US Pat. 527
It is known in, for example, Japanese Patent No. 9253.

【0005】[0005]

【発明が解決しようとする課題】しかし、上述した四つ
のティートカップを同時に装着する従来の自動搾乳機
は、各ティートカップをX方向,Y方向及びZ方向にそ
れぞれ変位させる四つの変位駆動機構部を、搾乳ロボッ
ト先端側に位置するエンドエフェクタに配設することに
より、各ティートカップを対応する乳頭に対して同時に
位置合わせする必要があるため、次のような問題があっ
た。
However, in the conventional automatic milking machine in which the above-mentioned four teat cups are simultaneously mounted, the four displacement driving mechanisms for displacing each teat cup in the X, Y and Z directions respectively. Is disposed on the end effector located on the distal end side of the milking robot, so that each teat cup needs to be simultaneously positioned with respect to the corresponding teat, thus causing the following problem.

【0006】第一に、エンドエフェクタは相当重くなる
ため、エンドエフェクタを移動させる大型のマニピュレ
ータが必要になり、全体の大型化,高コスト化及びエネ
ルギ消費の増大に伴う経済性の悪化を招くとともに、動
作の高速化を図れない。
First, since the end effector becomes considerably heavy, a large-sized manipulator for moving the end effector is required, which leads to an increase in size, cost, and an increase in energy consumption, resulting in a decrease in economic efficiency. , The operation cannot be speeded up.

【0007】第二に、エンドエフェクタの大型化により
牛体に対する安全性を確保しにくいとともに、エンドエ
フェクタの重量化により、制御誤差が生じやすく、しか
も、耐久性や信頼性の低下を招く。
Second, it is difficult to ensure safety for the cow body due to the increase in the size of the end effector, and the weight of the end effector tends to cause a control error, and also causes a decrease in durability and reliability.

【0008】本発明はこのような従来の技術に存在する
課題を解決したものであり、搾乳ロボット全体の小型コ
ンパクト化,低コスト化,軽量化及び高速化を図るとと
もに、経済性,安全性,耐久性及び信頼性の向上を図る
ことができる自動搾乳機の提供を目的とする。
The present invention has been made to solve the problems existing in the prior art, and aims to reduce the size, size, cost, weight, and speed of the whole milking robot, and at the same time, to improve economy, safety, and the like. It is an object of the present invention to provide an automatic milking machine capable of improving durability and reliability.

【0009】[0009]

【課題を解決するための手段及び実施の形態】本発明
は、乳頭H…に対応した複数のティートカップTa…を
支持するエンドエフェクタ2と、このエンドエフェクタ
2を移動させるマニピュレータ3と、エンドエフェクタ
2に対して各ティートカップTa…をそれぞれ変位させ
る複数の変位駆動機構部4a…を有することにより、テ
ィートカップTa…を乳頭H…に自動で装着する搾乳ロ
ボットMを備える自動搾乳機1を構成するに際して、エ
ンドエフェクタ2に、ティートカップTa…をX方向,
Y方向及びZ方向へ変位自在に支持するX方向変位部5
ax…,Y方向変位部5ay…及びZ方向変位部5az
…を有する変位機構部5a…を設けるとともに、エンド
エフェクタ2以外の部位に、X方向変位部5ax…,Y
方向変位部5ay…及びZ方向変位部5az…の全部
(又は一部)に対応した駆動部6ax…,6ay…及び
6az…を設け、当該駆動部6ax…と対応するX方向
変位部5ax…,Y方向変位部5ay…及びZ方向変位
部5az…の全部(又は一部)を、遠隔操作用伝達部7
ax…,7ay…及び7az…を介して接続した変位駆
動機構部4a…を備えることを特徴とする。
SUMMARY OF THE INVENTION The present invention provides an end effector 2 for supporting a plurality of teat cups Ta corresponding to nipples H, a manipulator 3 for moving the end effector 2, and an end effector. 2 has a plurality of displacement drive mechanisms 4a for respectively displacing each teat cup Ta, so that the automatic milking machine 1 includes a milking robot M for automatically attaching the teat cups Ta to the nipples H. To the end effector 2, the teat cup Ta ... in the X direction,
X-direction displacement unit 5 that supports displacement in the Y and Z directions
ax ..., Y-direction displacement parts 5ay ... and Z-direction displacement parts 5az
, And an X-direction displacement portion 5ax, Y at a portion other than the end effector 2.
, 6ay... 6az... Corresponding to all (or a part of) the Z-direction displacement portions 5ay... And the X-direction displacement portions 5ax. All (or a part) of the Y-direction displacement portions 5ay... And the Z-direction displacement portions 5az.
ax..., 7ay... and 7az.

【0010】この場合、好適な実施の形態により、X方
向変位部5ax…はエンドエフェクタ2のベース部10
にスライド自在に設けることによりX方向に変位するス
ライド部材11a…を有するとともに、Y方向変位部5
ay…はスライド部材11a…に後端部を回動自在に設
けることにより前端部がY方向に変位するアーム部材1
2a…を有する。また、Z方向変位部5az…はアーム
部材12a…の前端部に昇降自在に設けることによりZ
方向に変位する昇降部材13a…を有し、この昇降部材
13a…によりティートカップTa…を支持する。一
方、マニピュレータ3はエンドエフェクタ2をX方向,
Y方向及びZ方向に移動させるX方向移動部15,Y方
向移動部16及びZ方向移動部17を備える。この場
合、Y方向移動部16は前端部がY方向に移動する回動
アーム18を備え、この回動アーム18の後端部をX方
向移動部15及びZ方向移動部16により移動可能に支
持するとともに、当該回動アーム18の前端部にエンド
エフェクタ2を支持する。他方、回動アーム18の後端
部と一体に移動し、かつ駆動部6ax…を収容した駆動
ユニット19を備える。また、駆動部6ax…は直動ア
クチュエータ20…を用いるとともに、遠隔操作用伝達
部7ax…は伝達方向に対して位置を固定したアウタチ
ューブ21ax…と、このアウタチューブ21ax…の
内部にスライド自在に挿通し、かつ伝達方向に剛性を有
するインナワイヤ22ax…を有する。
In this case, according to a preferred embodiment, the X-direction displacement portions 5ax are connected to the base portion 10 of the end effector 2.
Are provided so as to be slidable, and are displaced in the X direction.
ay... are arm members 1 whose front ends are displaced in the Y direction by providing the rear ends of the slide members 11a.
2a ... The Z-direction displacement parts 5az are provided at the front end of the arm members 12a so as to be movable up and down.
, Which are displaced in the direction, and the teat cups Ta are supported by the elevating members 13a. On the other hand, the manipulator 3 moves the end effector 2 in the X direction,
An X direction moving unit 15, a Y direction moving unit 16, and a Z direction moving unit 17 for moving in the Y direction and the Z direction are provided. In this case, the Y-direction moving unit 16 includes a rotating arm 18 whose front end moves in the Y direction, and the rear end of the rotating arm 18 is movably supported by the X-direction moving unit 15 and the Z-direction moving unit 16. At the same time, the end effector 2 is supported at the front end of the rotating arm 18. On the other hand, there is provided a drive unit 19 that moves integrally with the rear end of the rotating arm 18 and houses the drive units 6ax. The drive units 6ax use the linear motion actuators 20, and the remote control transmission units 7ax are slidable inside the outer tubes 21ax... With their positions fixed in the transmission direction. Have inner wires 22ax which are inserted and have rigidity in the transmission direction.

【0011】このような構成により、エンドエフェクタ
2はマニピュレータ3によりX方向,Y方向及びZ方向
に移動する。即ち、エンドエフェクタ2(及びY方向移
動部16)は、X方向移動部15及びZ方向移動部17
により、X方向及びZ方向に移動するとともに、Y方向
移動部17を構成する回動アーム18の回動変位により
Y方向に移動する。また、エンドエフェクタ2に備える
各ティートカップTa…は、対応する変位駆動機構部4
a…により、それぞれX方向,Y方向及びZ方向に変位
する。即ち、エンドエフェクタ2以外の部位となるマニ
ピュレータ3における回動アーム18の後端部と一体に
移動する駆動ユニット19に収容した駆動部6ax…の
変位は、遠隔操作用伝達部7ax…を介して変位機構部
5a…におけるX方向変位部5ax…,Y方向変位部5
ay…及びZ方向変位部5az…に伝達され、ティート
カップTa…はX方向,Y方向及びZ方向に変位する。
具体的には、駆動部6ax…を構成する直動アクチュエ
ータ20…の進退変位は、遠隔操作用伝達部7ax…を
構成するインナワイヤ22ax…を介して、エンドエフ
ェクタ2のベース部10にスライド自在に設けたスライ
ド部材11a…に伝達され、当該スライド部材11a…
はX方向に変位するとともに、同様に駆動部6ay…の
進退変位は、当該スライド部材11a…に回動自在に設
けたアーム部材12a…に伝達され、当該アーム部材1
2a…の前端部はY方向に変位し、さらに、駆動部6a
z…の進退変位は、当該アーム部材12a…の前端部に
設けた昇降部材13a…に伝達され、当該昇降部材13
a…はZ方向に変位する。この結果、昇降部材13a…
に支持される各ティートカップTa…はX方向,Y方向
及びZ方向にそれぞれ変位する。
With such a configuration, the end effector 2 is moved by the manipulator 3 in the X, Y, and Z directions. That is, the end effector 2 (and the Y-direction moving unit 16) includes the X-direction moving unit 15 and the Z-direction moving unit 17.
As a result, it moves in the X and Z directions, and also moves in the Y direction due to the rotational displacement of the rotating arm 18 constituting the Y direction moving unit 17. Each teat cup Ta provided in the end effector 2 is provided with a corresponding displacement drive mechanism 4.
are displaced in the X, Y and Z directions, respectively. That is, the displacement of the drive units 6ax... Accommodated in the drive unit 19 that moves integrally with the rear end of the rotating arm 18 of the manipulator 3 that is a part other than the end effector 2 is transmitted via the remote control transmission unit 7ax. X-direction displacement parts 5ax, Y-direction displacement parts 5 in displacement mechanism parts 5a ...
are transmitted to the Z-direction displacement parts 5az, and the teat cups Ta are displaced in the X, Y, and Z directions.
Specifically, the forward / backward displacement of the linear motion actuators 20 constituting the drive units 6ax is slidably moved to the base unit 10 of the end effector 2 via the inner wires 22ax constituting the remote control transmission unit 7ax. Are transmitted to the provided slide members 11a.
Is displaced in the X direction, and similarly, the advance / retreat displacement of the drive units 6ay is transmitted to the arm members 12a rotatably provided on the slide members 11a, and the arm members 1a
2a are displaced in the Y direction, and
.. are transmitted to the lifting members 13a provided at the front end of the arm members 12a, and the lifting members 13a.
are displaced in the Z direction. As a result, the lifting members 13a ...
Are displaced in the X, Y, and Z directions, respectively.

【0012】よって、乳頭H…の位置を検出すれば、各
乳頭H…に対応するティートカップTa…を同時に位置
合わせすることができる。この場合、エンドエフェクタ
2には比較的重い駆動部6ax…が存在しないため、搾
乳ロボットM全体の小型コンパクト化及び軽量化が図ら
れ、エンドエフェクタ2を移動(変位)させる際の高速
化が可能になるとともに、エネルギ消費の低減に伴う経
済性,エンドエフェクタ2の小型化に伴う牛体への安全
性,さらには、エンドエフェクタ2の軽量化に伴う耐久
性及び信頼性の向上が図られる。
Therefore, if the positions of the nipples H are detected, the teat cups Ta corresponding to each nipple H can be simultaneously positioned. In this case, since the end effector 2 does not have a relatively heavy drive unit 6ax, the whole milking robot M can be reduced in size and weight and the speed of moving (displacing) the end effector 2 can be increased. At the same time, the economical efficiency due to the reduction of energy consumption, the safety to the cow body due to the downsizing of the end effector 2, and the durability and the reliability due to the weight reduction of the end effector 2 are achieved.

【0013】[0013]

【実施例】次に、本発明に係る好適な実施例を挙げ、図
面に基づき詳細に説明する。
Next, preferred embodiments according to the present invention will be described in detail with reference to the drawings.

【0014】まず、本実施例に係る自動搾乳機1を備え
るストールAの全体構成について、図4及び図5を参照
して説明する。
First, the overall configuration of a stall A including the automatic milking machine 1 according to the present embodiment will be described with reference to FIGS.

【0015】ストールAは一頭の乳牛Cを収容するため
の区画である。ストールAは複数のフレームF…の組み
合わせにより構成し、前部には餌槽111を備える。ま
た、ストールAの左後半部には後扉112を付設すると
ともに、左前半部には前扉113を付設し、後扉112
は前端部を、前扉113は後端部をそれぞれ回動支点と
して開閉する。114は乳牛Cの動きを抑制するための
踏台である。一方、1はストールAに付設した自動搾乳
機であり、搾乳ロボットMを備える。
The stall A is a compartment for accommodating one cow C. The stall A is composed of a combination of a plurality of frames F... A rear door 112 is attached to the left half of the stall A, and a front door 113 is attached to the left front half.
, The front door 113 is opened and closed using the rear end as a pivot point. Reference numeral 114 denotes a step for suppressing the movement of the cow C. On the other hand, 1 is an automatic milking machine attached to the stall A, and includes a milking robot M.

【0016】次に、搾乳ロボットMの構成について、図
1〜図9を参照して具体的に説明する。
Next, the configuration of the milking robot M will be specifically described with reference to FIGS.

【0017】搾乳ロボットMは大別して、乳頭H…に対
応した四つのティートカップTa,Tb,Tc及びTd
を支持するエンドエフェクタ2と、このエンドエフェク
タ2を移動させるマニピュレータ3と、エンドエフェク
タ2に対して各ティートカップTa…をそれぞれ変位さ
せる変位駆動機構部4a,4b,4c及び4dを有す
る。
The milking robot M is roughly divided into four teat cups Ta, Tb, Tc and Td corresponding to the teats H.
, A manipulator 3 for moving the end effector 2, and displacement drive mechanisms 4a, 4b, 4c and 4d for respectively displacing the teat cups Ta with respect to the end effector 2.

【0018】一方、ストールAの近傍にはロボット支持
フレーム31を設置し、このロボット支持フレーム31
の上部にX方向移動部15を取付ける。X方向移動部1
5はX方向に移動する可動部32を有する。X方向移動
部15としては、例えば、サーボモータとボールネジ機
構を組合わせた直動アクチュエータを利用できる。ま
た、可動部32にはZ方向移動部17を取付ける。Z方
向移動部17はZ方向に移動する可動部33を有する。
Z方向移動部17もX方向移動部15と同様の直動アク
チュエータを利用できる。そして、可動部33にはケー
シング34を有する駆動ユニット19を取付ける。な
お、駆動ユニット19の側面には表示部35d及び操作
部35cを有する制御盤35を配設する。
On the other hand, a robot supporting frame 31 is installed near the stall A, and the robot supporting frame 31 is installed.
The X-direction moving unit 15 is mounted on the upper part of. X direction moving unit 1
5 has a movable part 32 that moves in the X direction. As the X-direction moving unit 15, for example, a linear motion actuator combining a servo motor and a ball screw mechanism can be used. Further, the Z-direction moving unit 17 is attached to the movable unit 32. The Z direction moving section 17 has a movable section 33 that moves in the Z direction.
The Z-direction moving unit 17 can use the same linear motion actuator as the X-direction moving unit 15. Then, the drive unit 19 having the casing 34 is attached to the movable portion 33. Note that a control panel 35 having a display unit 35d and an operation unit 35c is provided on a side surface of the drive unit 19.

【0019】また、ケーシング34の下部にはY方向移
動部16を構成する回動アーム18の後端部を、ステッ
ピングモータ36により回動変位可能に取付ける。これ
により、回動アーム18の前端部はY方向に移動する。
一方、回動アーム18の前端部にはエンドエフェクタ2
のベース部10を、ステッピングモータ37により回動
変位可能に取付ける。これにより、エンドエフェクタ2
はY方向に平行移動する。
A rear end portion of the turning arm 18 constituting the Y-direction moving portion 16 is attached to a lower portion of the casing 34 so as to be rotatable by a stepping motor 36. As a result, the front end of the rotating arm 18 moves in the Y direction.
On the other hand, the end effector 2
Is mounted so as to be rotatable by a stepping motor 37. Thereby, the end effector 2
Translates in the Y direction.

【0020】他方、ティートカップTaは、エンドエフ
ェクタ2のベース部10に設けた変位機構部5aにより
支持される。変位機構部5aはX方向変位部5ax,Y
方向変位部5ay及びZ方向変位部5azを有し、これ
により、ティートカップTaはX方向,Y方向及びZ方
向に変位自在となる。この場合、X方向変位部5axは
ベース部10にスライド自在に設けることによりX方向
に変位するスライド部材11aを有するとともに、Y方
向変位部5ayは当該スライド部材11aに後端部を回
動自在に設けることにより、前端部がY方向に変位する
アーム部材12aを有する。また、Z方向変位部5az
は当該アーム部材12aの前端部に昇降自在に設けるこ
とによりZ方向に変位する昇降部材13aを有し、ティ
ートカップTaはこの昇降部材13aにより支持され
る。
On the other hand, the teat cup Ta is supported by a displacement mechanism 5a provided on the base 10 of the end effector 2. The displacement mechanism 5a includes an X-direction displacement unit 5ax, Y
The teat cup Ta has a direction displacement portion 5ay and a Z direction displacement portion 5az, so that the teat cup Ta can be freely displaced in the X direction, the Y direction, and the Z direction. In this case, the X-direction displacement portion 5ax has a slide member 11a that is displaced in the X-direction by slidably provided on the base portion 10, and the Y-direction displacement portion 5ay allows the rear end of the slide member 11a to rotate freely. By providing, the arm member 12a whose front end is displaced in the Y direction is provided. Also, the Z-direction displacement unit 5az
Has an elevating member 13a which is displaceable in the Z direction by being provided at the front end of the arm member 12a so as to be able to move up and down. The teat cup Ta is supported by the elevating member 13a.

【0021】この場合、Z方向変位部5azは図6に示
すように、下方に延出したガイドロッド42を有するカ
ップ係合部41を有し、ガイドロッド42はアーム部材
12aの前端部に設けたガイド孔部43によりZ方向へ
スライド自在に支持される。また、ティートカップTa
の上部にはフランジ部44を一体に有し、このフランジ
部44の一端部に引戻ワイヤ45の前端を結合する。こ
の引戻ワイヤ45は下方に導き、カップ係合部41に設
けた挿通孔部46に挿通させる。なお、47は凹状に形
成した嵌合部であり、フランジ部44の下面に設けた被
嵌合部48と嵌合してティートカップTaとカップ係合
部41の位置決めを行う。
In this case, as shown in FIG. 6, the Z-direction displacement portion 5az has a cup engaging portion 41 having a guide rod 42 extending downward, and the guide rod 42 is provided at the front end of the arm member 12a. The guide holes 43 are slidably supported in the Z direction. In addition, teat cup Ta
A flange portion 44 is integrally formed on the upper portion of the upper portion, and a front end of a pull-back wire 45 is connected to one end portion of the flange portion 44. The pull-back wire 45 is guided downward to be inserted through an insertion hole 46 provided in the cup engaging portion 41. Reference numeral 47 denotes a fitting portion formed in a concave shape. The fitting portion 47 fits with a fitted portion 48 provided on the lower surface of the flange portion 44 to position the teat cup Ta and the cup engaging portion 41.

【0022】他方、前記駆動ユニット19には、変位機
構部5aにおけるX方向変位部5ax,Y方向変位部5
ay及びZ方向変位部5azに対応する駆動部6ax,
6ay及び6azを収容する。駆動部6ax(6ay及
び6azも同じ)は、図9に示すように、サーボモータ
51とボールネジ機構52を用いた直動アクチュエータ
20を利用できる。なお、直動アクチュエータ20には
可動部の進退変位ストロークを検出するポテンショメー
タ53を付設する。
On the other hand, the drive unit 19 includes an X-direction displacement section 5ax and a Y-direction displacement section 5 in the displacement mechanism section 5a.
ay and a drive unit 6ax corresponding to the Z-direction displacement unit 5az,
6ay and 6az are accommodated. The drive unit 6ax (same for 6ay and 6az) can use a linear motion actuator 20 using a servomotor 51 and a ball screw mechanism 52, as shown in FIG. The linear actuator 20 is provided with a potentiometer 53 for detecting the forward / backward displacement stroke of the movable part.

【0023】また、駆動部6ax,6ay及び6az
と、対応するX方向変位部5ax,Y方向変位部5ay
及びZ方向変位部5azは、それぞれ遠隔操作用伝達部
7ax,7ay及び7azにより連結する。即ち、遠隔
操作用伝達部7axはアウタチューブ21axと、この
アウタチューブ21axの内部にスライド自在に挿通
し、かつ伝達方向に剛性を有するインナワイヤ22ax
を有し、アウタチューブ21axの前端はベース部10
に固定した固定ブラケット61aに結合するとともに、
後端は駆動ユニット19に固定した固定プレート62に
結合することにより、伝達方向の位置を固定する。そし
て、インナワイヤ22axの前端はスライド部材11a
に結合するとともに、後端は駆動部6axの可動部に結
合する。一方、遠隔操作用伝達部7ayも同様のアウタ
チューブ21ayとインナワイヤ22ayを有し、アウ
タチューブ21ayの前端は固定ブラケット61aに結
合するとともに、後端は固定プレート62に結合するこ
とにより、伝達方向の位置を固定する。そして、インナ
ワイヤ22ayの前端は図2に示すように、アーム部材
12aのレバー部63に回動自在に結合するとともに、
後端は駆動部6ayの可動部に結合する。他方、遠隔操
作用伝達部7azも同様のアウタチューブ21azとイ
ンナワイヤ22azを有し、アウタチューブ21azの
前端はアーム部材12aの前端に結合するとともに、後
端は固定プレート62に結合することにより、伝達方向
の位置を固定する。そして、インナワイヤ22azの前
端は昇降部材13aに結合するとともに、後端は駆動部
6azの可動部に結合する。このような、変位機構部5
a、駆動部6ax,6ay,6az及び遠隔操作用伝達
部7ax,7ay,7azは、エンドエフェクタ2に対
してティートカップTaを変位させる変位駆動機構部4
aを構成する。
The driving units 6ax, 6ay and 6az
And the corresponding X-direction displacement portion 5ax and Y-direction displacement portion 5ay
And the Z-direction displacement unit 5az are connected by remote control transmission units 7ax, 7ay and 7az, respectively. That is, the remote control transmission unit 7ax is slidably inserted into the outer tube 21ax and the inner wire 22ax having rigidity in the transmission direction.
And the front end of the outer tube 21ax is
To the fixed bracket 61a fixed to the
The rear end is connected to a fixed plate 62 fixed to the drive unit 19 to fix the position in the transmission direction. The front end of the inner wire 22ax is connected to the slide member 11a.
And the rear end is connected to the movable part of the drive unit 6ax. On the other hand, the remote control transmission unit 7ay also has the same outer tube 21ay and inner wire 22ay, and the front end of the outer tube 21ay is connected to the fixing bracket 61a and the rear end is connected to the fixing plate 62, so that the transmission direction can be changed. Fix the position. The front end of the inner wire 22ay is rotatably connected to the lever 63 of the arm member 12a as shown in FIG.
The rear end is connected to the movable part of the drive part 6ay. On the other hand, the transmission part 7az for remote control also has the same outer tube 21az and inner wire 22az, and the front end of the outer tube 21az is connected to the front end of the arm member 12a, and the rear end is connected to the fixed plate 62, so that transmission is possible. Fix the direction position. The front end of the inner wire 22az is connected to the elevating member 13a, and the rear end is connected to the movable part of the drive unit 6az. Such a displacement mechanism 5
a, the drive units 6ax, 6ay, 6az and the remote control transmission units 7ax, 7ay, 7az are a displacement drive mechanism unit 4 for displacing the teat cup Ta with respect to the end effector 2.
a.

【0024】他方、アーム部材12aの前端部と駆動ユ
ニット19に固定した支持プレート65間には、引戻用
アウタチューブ66の両端をそれぞれ結合するととも
に、引戻用アウタチューブ66の内部に前記引戻ワイヤ
45をスライド自在に挿通させ、引戻ワイヤ45の後端
は駆動ユニット19に収容した巻上機構部67により巻
上可能に構成する。巻上機構部67は巻上モータ68と
この巻上モータ68の回転軸に取付けた巻取プーリ69
を備える。
On the other hand, between the front end portion of the arm member 12a and the support plate 65 fixed to the drive unit 19, both ends of the outer tube 66 for retraction are connected, and the puller is inserted into the outer tube 66 for retraction. The return wire 45 is slidably inserted, and the rear end of the return wire 45 is configured to be able to be wound by a hoisting mechanism 67 housed in the drive unit 19. The hoisting mechanism 67 includes a hoisting motor 68 and a take-up pulley 69 mounted on a rotating shaft of the hoisting motor 68.
Is provided.

【0025】また、エンドエフェクタ2のベース部10
には、このような変位駆動機構部4aと同様に構成した
変位駆動機構部4b,4c及び4dを備え、対応する他
のティートカップTb,Tc,Tdを変位させる。この
場合、変位駆動機構部4b,4c及び4dは構成要素の
配設位置及び形状の相違を除き、変位駆動機構部4aと
同じである。
The base 10 of the end effector 2
Is provided with displacement drive mechanisms 4b, 4c and 4d configured in the same manner as the above displacement drive mechanism 4a, and displaces the corresponding other teat cups Tb, Tc and Td. In this case, the displacement drive mechanisms 4b, 4c, and 4d are the same as the displacement drive mechanism 4a except for differences in the arrangement positions and shapes of the components.

【0026】一方、搾乳ロボットMには乳牛Cの乳頭H
…の位置を検出する位置検出部を備える。
On the other hand, the milking robot M has a teat H of a cow C
Are provided.

【0027】まず、71はストールAに進入した乳牛C
(牛体)の位置を検出する牛***置センサであり、牛体
の後端に当接板72を当接させることにより乳牛Cの前
後方向位置を検出するとともに、当該当接板72と一体
に移動し、かつ横方からレーザ或いは超音波等を発する
反射型光学センサ73により乳牛Cの左右方向位置を検
出する。
First, 71 is a dairy cow C that has entered the stall A.
A cow body position sensor for detecting the position of the cow body. The cow body position sensor detects the position of the cow C in the front-rear direction by abutting the abutting plate 72 on the rear end of the cow body, and is integrated with the abutting plate 72. The position of the dairy cow C in the left-right direction is detected by the reflection type optical sensor 73 that moves from side to side and emits laser or ultrasonic waves from the side.

【0028】また、74,75はエンドエフェクタ2に
おけるベース部10の左右に配設した一対のレーザセン
サ(反射型光学センサ)である。この場合、右側に位置
するレーザセンサ74は左側に位置する二つの乳頭H…
の位置を検出するとともに、左側に位置するレーザセン
サ75は右側に位置する二つの乳頭H…の位置を検出す
る。一方のレーザセンサ74はベース部10に固定した
センサ支持部76に昇降自在に支持されるセンサ昇降部
77を有するとともに、このセンサ昇降部77の上面に
回動部78rを介して回動自在に取付けたセンサカバー
78を有する。このセンサカバー78は外光による影響
を防止するもので、前方が開放されたボックス状に形成
し、内部にレーザセンサ本体74mを収容する。
Reference numerals 74 and 75 denote a pair of laser sensors (reflection type optical sensors) disposed on the left and right sides of the base 10 in the end effector 2. In this case, the laser sensor 74 located on the right side has two nipples H located on the left side.
, And the laser sensor 75 located on the left side detects the positions of the two nipples H located on the right side. One of the laser sensors 74 has a sensor elevating part 77 supported by a sensor supporting part 76 fixed to the base part 10 so as to be able to move up and down, and is rotatably provided on the upper surface of the sensor elevating part 77 via a turning part 78r. It has a sensor cover 78 attached. The sensor cover 78 prevents the influence of external light, is formed in a box shape with an open front, and accommodates the laser sensor main body 74m inside.

【0029】一方、駆動ユニット19には駆動部79,
80を収容し、駆動部79とセンサ昇降部77を遠隔操
作用伝達部81により連結するとともに、駆動部80と
センサカバー78を遠隔操作用伝達部84により連結す
る。即ち、遠隔操作用伝達部81はアウタチューブ82
と、このアウタチューブ82の内部にスライド自在に挿
通し、かつ伝達方向に剛性を有するインナワイヤ83を
有し、アウタチューブ82の前端はセンサ支持部76に
結合するとともに、後端は駆動ユニット19の固定プレ
ート62に結合することにより、伝達方向の位置を固定
する。そして、インナワイヤ83の前端はセンサ昇降部
77に結合するとともに、後端は駆動部79の可動部に
結合する。他方、遠隔操作用伝達部84も同様のアウタ
チューブ85とインナワイヤ86を有し、アウタチュー
ブ85の前端はセンサ昇降部77に結合するとともに、
後端は固定プレート62に結合することにより、伝達方
向の位置を固定する。そして、インナワイヤ86の前端
は図3に示すように、センサカバー78に設けたレバー
部87に回動自在に結合するとともに、後端は駆動部8
0の可動部に結合する。なお、他方のレーザセンサ75
もレーザセンサ74と同様に構成する。
On the other hand, the driving unit 19 includes a driving unit 79,
The driving unit 79 and the sensor elevating unit 77 are connected by a remote control transmission unit 81, and the drive unit 80 and the sensor cover 78 are connected by a remote control transmission unit 84. That is, the transmission part 81 for remote operation is
And an inner wire 83 slidably inserted into the outer tube 82 and having rigidity in the transmission direction. The front end of the outer tube 82 is connected to the sensor support portion 76, and the rear end of the By coupling to the fixed plate 62, the position in the transmission direction is fixed. The front end of the inner wire 83 is connected to the sensor elevating unit 77, and the rear end of the inner wire 83 is connected to the movable unit of the driving unit 79. On the other hand, the remote control transmission unit 84 also has the same outer tube 85 and inner wire 86, and the front end of the outer tube 85 is coupled to the sensor elevating unit 77,
The rear end is fixed to the fixing plate 62 to fix the position in the transmission direction. The front end of the inner wire 86 is rotatably connected to a lever 87 provided on the sensor cover 78 as shown in FIG.
0 movable part. The other laser sensor 75
The configuration is the same as that of the laser sensor 74.

【0030】さらに、一つのティートカップTaに対し
てフォトアレイセンサ90を付設する。91はベース部
10に配設した昇降支持部であり、この昇降支持部91
の上端部にフォトアレイセンサ90を取付ける。これに
より、フォトアレイセンサ90はティートカップTaの
上方に位置し、昇降支持部91により昇降する。フォト
アレイセンサ90は図8に示すように、矩形枠状のセン
サフレーム92を有し、内側に乳頭Hを入れることがで
きる。センサフレーム92は,左フレーム部92a,右
フレーム部92b,前フレーム部92c及び後フレーム
部92dからなり、センサフレーム92のフレーム内部
には図8に示すように、発光部93…と受光部94…か
らなる複数組の光学センサを配設する。これにより、セ
ンサフレーム92の内方の空間にはマトリクス状の光路
E…が形成される。
Further, a photo array sensor 90 is attached to one teat cup Ta. Reference numeral 91 denotes an elevating support provided on the base 10.
A photoarray sensor 90 is attached to the upper end of the photosensor. As a result, the photo array sensor 90 is located above the teat cup Ta, and is moved up and down by the elevating support unit 91. As shown in FIG. 8, the photo array sensor 90 has a rectangular frame-shaped sensor frame 92, and a nipple H can be inserted inside. The sensor frame 92 includes a left frame portion 92a, a right frame portion 92b, a front frame portion 92c, and a rear frame portion 92d. As shown in FIG. Are provided. Thereby, a matrix of optical paths E are formed in the space inside the sensor frame 92.

【0031】次に、自動搾乳機1における搾乳ロボット
Mの制御系統について、図9を参照して説明する。
Next, a control system of the milking robot M in the automatic milking machine 1 will be described with reference to FIG.

【0032】図9中、100はコントローラであり、制
御部101,記憶部102及びドライブ部103を備え
る。また、制御部101には牛体識別センサ104及び
牛***置センサ71を接続するとともに、レーザセンサ
74,75及びフォトアレイセンサ90を接続する。一
方、マニピュレータ3(ステッピングモータ36,3
7、X方向移動部15,Z方向移動部17)は制御部1
01に接続する。また、駆動部6ax…(他の駆動部も
同じ)はドライブ部103に接続するとともに、駆動部
6ax…(他の駆動部も同じ)に付設したポテンショメ
ータ53…は制御部101に接続する。
In FIG. 9, reference numeral 100 denotes a controller, which includes a control unit 101, a storage unit 102, and a drive unit 103. The control unit 101 is connected to the bovine identification sensor 104 and the bovine position sensor 71, and is also connected to the laser sensors 74 and 75 and the photo array sensor 90. On the other hand, the manipulator 3 (stepping motors 36, 3)
7, X direction moving unit 15, Z direction moving unit 17)
Connect to 01. (The other driving units are the same) are connected to the driving unit 103, and the potentiometers 53 attached to the driving units 6ax (the other driving units are the same) are connected to the control unit 101.

【0033】次に、本実施例に係る自動搾乳機1の動
作、特にティートカップの装着手順について、図12に
示すフローチャート及び図1〜図11を参照して説明す
る。
Next, the operation of the automatic milking machine 1 according to the present embodiment, in particular, the procedure for mounting the teat cup will be described with reference to the flowchart shown in FIG. 12 and FIGS.

【0034】今、ストールA内に乳牛Cが進入すれば、
扉112を閉じ、牛体識別センサ104により乳牛Cの
識別処理を行う(ステップS1,S2)。乳牛CはID
コードを記憶した首輪を掛けており、ストールAの前部
に配設した不図示のコード読取器によりIDコードを読
取って乳牛Cを識別する。そして、識別した乳牛Cのデ
ータを記憶部102に記憶したデータベースから読み出
すとともに、牛***置センサ71により乳牛Cの位置を
検出し、データベース及び位置の検出結果に基づいて、
エンドエフェタ2を図5に実線で示すホームポジョンか
ら標準位置となる仮想線位置まで移動させる(ステップ
S3,S4,S5)。この場合、制御部101によりマ
ニピュレータ3を駆動制御する。
Now, if cow C enters stall A,
The door 112 is closed, and the dairy cow C is identified by the cow identification sensor 104 (steps S1 and S2). Cow C is ID
A cow having a collar storing a code is read, and a cow C is identified by reading an ID code by a code reader (not shown) arranged in front of the stall A. Then, the data of the identified dairy cow C is read from the database stored in the storage unit 102, and the position of the dairy cow C is detected by the cow body position sensor 71.
The end effector 2 is moved from the home position shown by a solid line in FIG. 5 to a virtual line position serving as a standard position (steps S3, S4, S5). In this case, the control unit 101 controls the driving of the manipulator 3.

【0035】次いで、レーザセンサ74を図10に示す
設定角度Qだけ回動変位させ、右側に位置する二つの乳
頭H…の位置を検出する。この際、レーザセンサ74
は、最初に、図11に仮想線で示すホームポジション
(下限位置)において検出を行う。この際、検出しない
場合には予め設定した一定量のストロークKoだけレー
ザセンサ74を上昇させることにより、同様にレーザセ
ンサ74を設定角度Qだけ回動変位させ、乳頭H…の位
置を検出する処理を繰り返す(ステップS6,S7,S
8)。この場合、駆動部79を駆動制御すれば、インナ
ワイヤ83が進退変位し、レーザセンサ74(センサカ
バー78)を回動変位させることができるとともに、駆
動部80を駆動制御すれば、インナワイヤ86が前進変
位し、レーザセンサ74を上昇させることができる。な
お、図10はレーザセンサ74をホームポジションから
ストロークKuだけ上昇させた際に、乳頭H…を検出し
た状態を示している。これにより、乳頭H…までの高さ
(Z方向位置)と乳頭H…の位置(X方向位置及びY方
向位置)を検出できる。同様の処理はレーザセンサ75
においても行う。
Next, the laser sensor 74 is rotated and displaced by the set angle Q shown in FIG. 10 to detect the positions of the two nipples H. At this time, the laser sensor 74
First, detection is performed at a home position (lower limit position) indicated by a virtual line in FIG. At this time, if the detection is not performed, the laser sensor 74 is raised by a predetermined fixed amount of stroke Ko, thereby similarly rotating the laser sensor 74 by the set angle Q to detect the position of the nipples H. (Steps S6, S7, S
8). In this case, if the drive of the drive unit 79 is controlled, the inner wire 83 can be moved forward and backward, and the laser sensor 74 (sensor cover 78) can be rotated and displaced. If the drive of the drive unit 80 is controlled, the inner wire 86 can be moved forward. The laser sensor 74 can be displaced and raised. FIG. 10 shows a state where the nipples H are detected when the laser sensor 74 is raised from the home position by the stroke Ku. Thereby, the height (Z-direction position) up to the nipple H ... and the position of the nipple H ... (X-direction position and Y-direction position) can be detected. Similar processing is performed by the laser sensor 75.
Also in

【0036】そして、レーザセンサ74,75による検
出結果に基づいて、各ティートカップTa,Tb,Tc
及びTdを対応する乳頭H…の下方に位置させる(ステ
ップS9)。この場合、各駆動部6ax…を駆動制御
し、インナワイヤ22ax…を進退変位させることによ
り、各ティートカップTa…をX方向及びY方向に変位
させる。
Then, based on the detection results by the laser sensors 74 and 75, each teat cup Ta, Tb, Tc
And Td are positioned below the corresponding nipples H (step S9). In this case, each teat cup Ta is displaced in the X direction and the Y direction by controlling the drive of each drive unit 6ax and moving the inner wires 22ax forward and backward.

【0037】次いで、フォトアレイセンサ90を上昇さ
せ、乳頭Hをセンサフレーム91に入れることにより乳
頭Hの位置を検出する。即ち、センサフレーム91の内
方の空間に形成されたマトリクス状の光路E…の一部は
乳頭Hにより遮断されるため、この情報に基づいて制御
部101は乳頭Hの位置を検出する(ステップS1
0)。この場合、光路E…はマトリクス状のため、正確
(高精度)に検出できる。一方、制御部101はこの位
置検出結果に基づいて、X方向移動部15とY方向移動
部16を駆動制御し、乳頭Hがセンサフレーム91の内
方の空間の中心(ティートカップTcの中心)に位置す
るようにマニピュレータ3によりエンドエフェクタ2を
移動させて位置決めする(ステップS11)。
Next, the position of the nipple H is detected by raising the photoarray sensor 90 and inserting the nipple H into the sensor frame 91. That is, since a part of the matrix-like optical paths E formed in the space inside the sensor frame 91 is blocked by the nipple H, the control unit 101 detects the position of the nipple H based on this information (step). S1
0). In this case, since the optical paths E are in a matrix form, they can be detected accurately (highly accurate). On the other hand, the control unit 101 drives and controls the X-direction moving unit 15 and the Y-direction moving unit 16 based on the position detection result, so that the nipple H is at the center of the space inside the sensor frame 91 (the center of the teat cup Tc). The end effector 2 is moved and positioned by the manipulator 3 so as to be positioned at (step S11).

【0038】そして、乳頭Hがセンサフレーム91の中
心に位置するように位置決めしたなら、各ティートカッ
プTa,Tb,Tc及びTdを同時に上昇させる。即
ち、駆動部6az…を駆動制御し、インナワイヤ22a
z…を前進変位させることにより、カップ係合部41…
を上昇させれば、カップ係合部41…の上面にフランジ
部44…が載った状態でティートカップTa…も一緒に
上昇する。この際、嵌合部47…と被嵌合部48…は嵌
合して位置決めされる。一方、ティートカップTa…が
ある程度上昇すれば、負圧により乳頭H…が吸い込まれ
て真空接続される(ステップS12)。接続されたなら
ティートカップTa…の上昇を停止するとともに、カッ
プ係合部41…を下降させる。これにより、カップ係合
部41…はフランジ部44…から離間し、ティートカッ
プTa…と昇降部材13a…間は引戻ワイヤ45のみと
なり、ティートカップTa…は水平方向へ変位自在とな
る。ティートカップTa…の装着が終了したなら搾乳を
開始する。他方、搾乳が終了したなら、巻上機構部67
…によりワイヤ45…を巻上げれば、フランジ部44…
が下方に引張られ、ティートカップTa…は下限位置に
戻される。
When the nipple H is positioned at the center of the sensor frame 91, the teat cups Ta, Tb, Tc and Td are simultaneously raised. That is, the driving of the driving units 6az is controlled and the inner wires 22a are controlled.
By moving the z forward, the cup engaging portions 41.
Is raised, the teat cups Ta rise together with the flanges 44 lying on the upper surface of the cup engaging parts 41. At this time, the fitting portions 47 and the fitted portions 48 are fitted and positioned. On the other hand, when the teat cups Ta rise to some extent, the nipples H are sucked by the negative pressure and vacuum-connected (step S12). When the teat cups Ta are connected, the raising of the teat cups Ta is stopped, and the cup engaging portions 41 are lowered. Thereby, the cup engaging portions 41 are separated from the flange portions 44, and only the pull-back wire 45 is provided between the teat cup Ta and the elevating member 13a, so that the teat cups Ta can be displaced in the horizontal direction. When the attachment of the teat cups Ta is completed, milking is started. On the other hand, when the milking is completed, the winding mechanism 67
When the wire 45 is wound by the flange 44,
Are pulled downward, and the teat cups Ta are returned to the lower limit position.

【0039】以上、実施例について詳細に説明したが、
本発明はこのような実施例に限定されるものではない。
例えば、駆動部は全部を駆動ユニットに収容したが、一
部であってもよい。また、駆動部は駆動ユニットに収容
したが、他の部位、例えば、回動アームの下面等に配設
してもよい。さらに、遠隔操作用伝達部はワイヤ部材を
用いたが、リンク部材の組合わせ等により構成してもよ
い。その他、細部の構成,形状等において、本発明の精
神を逸脱しない範囲で任意に変更できる。
The embodiment has been described in detail above.
The present invention is not limited to such an embodiment.
For example, the entire drive unit is housed in the drive unit, but may be a part. Further, although the drive unit is housed in the drive unit, it may be provided on another portion, for example, on the lower surface of the rotating arm. Further, although the transmission member for remote control uses a wire member, it may be configured by a combination of link members or the like. In addition, details, configurations, shapes, and the like can be arbitrarily changed without departing from the spirit of the present invention.

【0040】[0040]

【発明の効果】このように本発明に係る自動搾乳機は、
エンドエフェクタに、ティートカップをX方向,Y方向
及びZ方向へ変位自在に支持するX方向変位部,Y方向
変位部及びZ方向変位部を有する変位機構部を設けると
ともに、エンドエフェクタ以外の部位に、X方向変位
部,Y方向変位部及びZ方向変位部に対応した駆動部を
設け、当該駆動部と対応するX方向変位部,Y方向変位
部及びZ方向変位部を、遠隔操作用伝達部により接続し
たため、次のような顕著な効果を奏する。
As described above, the automatic milking machine according to the present invention comprises:
The end effector is provided with a displacement mechanism portion having an X-direction displacement portion, a Y-direction displacement portion, and a Z-direction displacement portion for supporting the teat cup so that the teat cup can be displaced in the X, Y, and Z directions, and at a portion other than the end effector. , A drive unit corresponding to the X-direction displacement unit, the Y-direction displacement unit, and the Z-direction displacement unit, and the X-direction displacement unit, the Y-direction displacement unit, and the Z-direction displacement unit corresponding to the drive unit are connected to a remote control transmission unit. As a result, the following remarkable effects are achieved.

【0041】 エンドエフェクタの大幅な軽量化によ
り、エンドエフェクタを移動させる大型のマニピュレー
タが不要になるため、搾乳ロボットの低コスト化及び動
作の高速化を図れるとともに、エネルギ消費の低減に伴
う経済性向上、制御誤差の低減,耐久性及び信頼性の向
上を図ることができる。
The large weight reduction of the end effector eliminates the need for a large manipulator to move the end effector, so that the milking robot can be reduced in cost and speed of operation, and the economic efficiency can be improved by reducing energy consumption. In addition, control errors can be reduced, and durability and reliability can be improved.

【0042】 エンドエフェクタの小型化及び搾乳ロ
ボット全体の小型コンパクト化を図れるとともに、特
に、エンドエフェクタの小型化により、牛体に対する安
全性を高めることができる。
The size of the end effector and the size and size of the whole milking robot can be reduced, and in particular, the size of the end effector can improve the safety of the cow body.

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

【図1】本発明に係る自動搾乳機における搾乳ロボット
に備える変位駆動機構部の構成図、
FIG. 1 is a configuration diagram of a displacement drive mechanism provided in a milking robot in an automatic milking machine according to the present invention,

【図2】同搾乳ロボットに備えるエンドエフェクタの平
面図、
FIG. 2 is a plan view of an end effector provided in the milking robot;

【図3】同搾乳ロボットに備えるレーザセンサの一部断
面平面図、
FIG. 3 is a partial cross-sectional plan view of a laser sensor provided in the milking robot;

【図4】本発明に係る自動搾乳機を備えるストールの側
面図、
FIG. 4 is a side view of a stall provided with the automatic milking machine according to the present invention,

【図5】同自動搾乳機を備えるストールの平面図、FIG. 5 is a plan view of a stall provided with the automatic milking machine,

【図6】同自動搾乳機の搾乳ロボットに備える変位駆動
機構部におけるZ方向変位部の側面図、
FIG. 6 is a side view of a Z-direction displacement unit in a displacement drive mechanism provided in the milking robot of the automatic milking machine;

【図7】同自動搾乳機の搾乳ロボットに備えるレーザセ
ンサの一部断面側面図、
FIG. 7 is a partial cross-sectional side view of a laser sensor included in a milking robot of the automatic milking machine;

【図8】同自動搾乳機の搾乳ロボットに備えるフォトア
レイセンサの断面平面図、
FIG. 8 is a cross-sectional plan view of a photoarray sensor included in a milking robot of the automatic milking machine,

【図9】同自動搾乳機の搾乳ロボットにおける制御系の
ブロック系統図、
FIG. 9 is a block diagram of a control system in a milking robot of the automatic milking machine,

【図10】同自動搾乳機の搾乳ロボットにおけるレーザ
センサの動作説明図、
FIG. 10 is an explanatory diagram of an operation of a laser sensor in the milking robot of the automatic milking machine;

【図11】同自動搾乳機の搾乳ロボットにおけるレーザ
センサの他の動作説明図、
FIG. 11 is another operation explanatory view of the laser sensor in the milking robot of the automatic milking machine;

【図12】同自動搾乳機によるティートカップの装着手
順を示すフローチャート、
FIG. 12 is a flowchart showing a procedure for attaching a teat cup by the automatic milking machine;

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

1 自動搾乳機 2 エンドエフェクタ 3 マニピュレータ 4a… 変位駆動機構部 5ax… X方向変位部 5ay… Y方向変位部 5az… Z方向変位部 5a… 変位機構部 6ax… 駆動部 6ay… 駆動部 6az… 駆動部 7ax… 遠隔操作用伝達部 7ay… 遠隔操作用伝達部 7az… 遠隔操作用伝達部 10 ベース部 11a… スライド部材 12a… アーム部材 13a… 昇降部材 15 X方向移動部 16 Y方向移動部 17 Z方向移動部 18 回動アーム 19 駆動ユニット 20… 直動アクチュエータ 21ax… アウタチューブ 22ax… インナワイヤ M 搾乳ロボット H… 乳頭 Ta… ティートカップ DESCRIPTION OF SYMBOLS 1 Automatic milking machine 2 End effector 3 Manipulator 4a ... Displacement drive mechanism part 5ax ... X direction displacement part 5ay ... Y direction displacement part 5az ... Z direction displacement part 5a ... Displacement mechanism part 6ax ... Drive part 6ay ... Drive part 6az ... Drive part 7ax ... Remote operation transmission part 7ay ... Remote operation transmission part 7az ... Remote operation transmission part 10 Base part 11a ... Sliding member 12a ... Arm member 13a ... Elevating member 15 X direction moving part 16 Y direction moving part 17 Z direction moving Part 18 Rotating arm 19 Drive unit 20 Linear actuator 21ax Outer tube 22ax Inner wire M Milking robot H ... Nipple Ta ... Teat cup

─────────────────────────────────────────────────────
────────────────────────────────────────────────── ───

【手続補正書】[Procedure amendment]

【提出日】平成8年9月25日[Submission date] September 25, 1996

【手続補正1】[Procedure amendment 1]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0033[Correction target item name] 0033

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0033】次に、本実施例に係る自動搾乳機1の動
作、特にティートカップの装着手順について、図1〜図
11を参照して説明する。
Next, the operation of the automatic milking machine 1 according to the present embodiment, in particular, the procedure for mounting the teat cup will be described with reference to FIGS.

【手続補正2】[Procedure amendment 2]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0034[Correction target item name] 0034

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0034】今、ストールA内に乳牛Cが進入すれば、
扉112を閉じ、牛体識別センサ104により乳牛Cの
識別処理を行う。乳牛CはIDコードを記憶した首輪を
掛けており、ストールAの前部に配設した不図示のコー
ド読取器によりIDコードを読取って乳牛Cを識別す
る。そして、識別した乳牛Cのデータを記憶部102に
記憶したデータベースから読み出すとともに、牛***置
センサ71により乳牛Cの位置を検出し、データベース
及び位置の検出結果に基づいて、エンドエフェタ2を図
5に実線で示すホームポジョンから標準位置となる仮想
線位置まで移動させる。この場合、制御部101により
マニピュレータ3を駆動制御する。
Now, if cow C enters stall A,
The door 112 is closed, and the cow identification sensor 104 performs identification processing of the cow C. The dairy cow C is wearing a collar storing the ID code, and the dairy cow C is identified by reading the ID code by a code reader (not shown) arranged in front of the stall A. Then, the data of the identified cow C is read from the database stored in the storage unit 102, the position of the cow C is detected by the cow body position sensor 71, and the end effector 2 is moved to the position shown in FIG. It is moved from the home position indicated by the solid line to the virtual line position serving as the standard position. In this case, the control unit 101 controls the driving of the manipulator 3.

【手続補正3】[Procedure amendment 3]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0035[Correction target item name] 0035

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0035】次いで、レーザセンサ74を図10に示す
設定角度Qだけ回動変位させ、右側に位置する二つの乳
頭H…の位置を検出する。この際、レーザセンサ74
は、最初に、図11に仮想線で示すホームポジション
(下限位置)において検出を行う。この際、検出しない
場合には予め設定した一定量のストロークKloだけレ
ーザセンサ74を上昇させることにより、同様にレーザ
センサ74を設定角度Qだけ回動変位させ、乳頭H…の
位置を検出する処理を繰り返す。この場合、駆動部79
を駆動制御すれば、インナワイヤ83が進退変位し、レ
ーザセンサ74(センサカバー78)を回動変位させる
ことができるとともに、駆動部80を駆動制御すれば、
インナワイヤ86が前進変位し、レーザセンサ74を上
昇させることができる。なお、図10はレーザセンサ7
4をホームポジションからストロークKuだけ上昇させ
た際に、乳頭H…を検出した状態を示している。これに
より、乳頭H…までの高さ(Z方向位置)と乳頭H…の
位置(X方向位置及びY方向位置)を検出できる。同様
の処理はレーザセンサ75においても行う。
Next, the laser sensor 74 is rotated and displaced by the set angle Q shown in FIG. 10 to detect the positions of the two nipples H. At this time, the laser sensor 74
First, detection is performed at a home position (lower limit position) indicated by a virtual line in FIG. At this time, if not detected, the laser sensor 74 is raised by a predetermined fixed amount of stroke Klo, thereby similarly rotating and displacing the laser sensor 74 by the set angle Q to detect the position of the nipples H. repeat. In this case, the driving unit 79
, The inner wire 83 moves forward and backward, and the laser sensor 74 (sensor cover 78) can be rotationally displaced.
The inner wire 86 is displaced forward, and the laser sensor 74 can be raised. FIG. 10 shows the laser sensor 7.
4 shows a state in which the nipples H are detected when the stroke No. 4 is raised from the home position by the stroke Ku. Thereby, the height (Z-direction position) up to the nipple H ... and the position of the nipple H ... (X-direction position and Y-direction position) can be detected. The same processing is performed in the laser sensor 75.

【手続補正4】[Procedure amendment 4]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0036[Correction target item name] 0036

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0036】そして、レーザセンサ74,75による検
出結果に基づいて、各ティートカップTa,Tb,Tc
及びTdを対応する乳頭H…の下方に位置させる。この
場合、各駆動部6ax…を駆動制御し、インナワイヤ2
2ax…を進退変位させることにより、各ティートカッ
プTa…をX方向及びY方向に変位させる。
Then, based on the detection results by the laser sensors 74 and 75, each teat cup Ta, Tb, Tc
And Td are located below corresponding nipples H. In this case, the driving of each of the driving units 6ax.
Are moved in the X and Y directions by moving the 2ax... Forward and backward.

【手続補正5】[Procedure amendment 5]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0037[Correction target item name] 0037

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0037】次いで、フォトアレイセンサ90を上昇さ
せ、乳頭Hをセンサフレーム91に入れることにより乳
頭Hの位置を検出する。即ち、センサフレーム91の内
方の空間に形成されたマトリクス状の光路E…の一部は
乳頭Hにより遮断されるため、この情報に基づいて制御
部101は乳頭Hの位置を検出する。この場合、光路E
…はマトリクス状のため、正確(高精度)に検出でき
る。一方、制御部101はこの位置検出結果に基づい
て、X方向移動部15とY方向移動部16を駆動制御
し、乳頭Hがセンサフレーム91の内方の空間の中心
(ティートカップTcの中心)に位置するようにマニピ
ュレータ3によりエンドエフェクタ2を移動させて位置
決めする。
Next, the position of the nipple H is detected by raising the photoarray sensor 90 and inserting the nipple H into the sensor frame 91. That is, since a part of the matrix-like optical paths E formed in the space inside the sensor frame 91 is blocked by the nipple H, the control unit 101 detects the position of the nipple H based on this information. In this case, the optical path E
.. Can be detected accurately (highly accurate) because they are in a matrix. On the other hand, the control unit 101 drives and controls the X-direction moving unit 15 and the Y-direction moving unit 16 based on the position detection result, so that the nipple H is at the center of the space inside the sensor frame 91 (the center of the teat cup Tc). The end effector 2 is moved by the manipulator 3 so that the end effector 2 is positioned.

【手続補正6】[Procedure amendment 6]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】0038[Correction target item name] 0038

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

【0038】そして、乳頭Hがセンサフレーム91の中
心に位置するように位置決めしたなら、各ティートカッ
プTa,Tb,Tc及びTdを同時に上昇させる。即
ち、駆動部6az…を駆動制御し、インナワイヤ22a
z…を前進変位させることにより、カップ係合部41…
を上昇させれば、カップ係合部41…の上面にフランジ
部44…が載った状態でティートカップTa…も一緒に
上昇する。この際、嵌合部47…と被嵌合部48…は嵌
合して位置決めされる。一方、ティートカップTa…が
ある程度上昇すれば、負圧により乳頭H…が吸い込まれ
て真空接続される。接続されたならティートカップTa
…の上昇を停止するとともに、カップ係合部41…を下
降させる。これにより、カップ係合部41…はフランジ
部44…から離間し、ティートカップTa…と昇降部材
13a…間は引戻ワイヤ45のみとなり、ティートカッ
プTa…は水平方向へ変位自在となる。ティートカップ
Ta…の装着が終了したなら搾乳を開始する。他方、搾
乳が終了したなら、巻上機構部67…によりワイヤ45
…を巻上げれば、フランジ部44…が下方に引張られ、
ティートカップTa…は下限位置に戻される。
When the nipple H is positioned at the center of the sensor frame 91, the teat cups Ta, Tb, Tc and Td are simultaneously raised. That is, the driving of the driving units 6az is controlled and the inner wires 22a are controlled.
By moving the z forward, the cup engaging portions 41.
Is raised, the teat cups Ta rise together with the flanges 44 lying on the upper surface of the cup engaging parts 41. At this time, the fitting portions 47 and the fitted portions 48 are fitted and positioned. On the other hand, when the teat cups Ta rise to some extent, the nipples H are sucked by the negative pressure and vacuum-connected. If connected, teat cup Ta
Are stopped and the cup engaging portions 41 are lowered. Thereby, the cup engaging portions 41 are separated from the flange portions 44, and only the pull-back wire 45 is provided between the teat cup Ta and the elevating member 13a, so that the teat cups Ta can be displaced in the horizontal direction. When the attachment of the teat cups Ta is completed, milking is started. On the other hand, when the milking is completed, the wire 45 is moved by the hoisting mechanism 67.
..., the flange portions 44 are pulled downward,
Are returned to the lower limit position.

【手続補正7】[Procedure amendment 7]

【補正対象書類名】明細書[Document name to be amended] Statement

【補正対象項目名】図面の簡単な説明[Correction target item name] Brief description of drawings

【補正方法】変更[Correction method] Change

【補正内容】[Correction contents]

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

【図1】本発明に係る自動搾乳機における搾乳ロボット
に備える変位駆動機構部の構成図、
FIG. 1 is a configuration diagram of a displacement drive mechanism provided in a milking robot in an automatic milking machine according to the present invention,

【図2】同搾乳ロボットに備えるエンドエフェクタの平
面図、
FIG. 2 is a plan view of an end effector provided in the milking robot;

【図3】同搾乳ロボットに備えるレーザセンサの一部断
面平面図、
FIG. 3 is a partial cross-sectional plan view of a laser sensor provided in the milking robot;

【図4】本発明に係る自動搾乳機を備えるストールの側
面図、
FIG. 4 is a side view of a stall provided with the automatic milking machine according to the present invention,

【図5】同自動搾乳機を備えるストールの平面図、FIG. 5 is a plan view of a stall provided with the automatic milking machine,

【図6】同自動搾乳機の搾乳ロボットに備える変位駆動
機構部におけるZ方向変位部の側面図、
FIG. 6 is a side view of a Z-direction displacement unit in a displacement drive mechanism provided in the milking robot of the automatic milking machine;

【図7】同自動搾乳機の搾乳ロボットに備えるレーザセ
ンサの一部断面側面図、
FIG. 7 is a partial cross-sectional side view of a laser sensor included in a milking robot of the automatic milking machine;

【図8】同自動搾乳機の搾乳ロボットに備えるフォトア
レイセンサの断面平面図、
FIG. 8 is a cross-sectional plan view of a photoarray sensor included in a milking robot of the automatic milking machine,

【図9】同自動搾乳機の搾乳ロボットにおける制御系の
ブロック系統図、
FIG. 9 is a block diagram of a control system in a milking robot of the automatic milking machine,

【図10】同自動搾乳機の搾乳ロボットにおけるレーザ
センサの動作説明図、
FIG. 10 is an explanatory diagram of an operation of a laser sensor in the milking robot of the automatic milking machine;

【図11】同自動搾乳機の搾乳ロボットにおけるレーザ
センサの他の動作説明図、
FIG. 11 is another operation explanatory view of the laser sensor in the milking robot of the automatic milking machine;

【符号の説明】 1 自動搾乳機 2 エンドエフェクタ 3 マニピュレータ 4a… 変位駆動機構部 5ax… X方向変位部 5ay… Y方向変位部 5az… Z方向変位部 5a… 変位機構部 6ax… 駆動部 6ay… 駆動部 6az… 駆動部 7ax… 遠隔操作用伝達部 7ay… 遠隔操作用伝達部 7az… 遠隔操作用伝達部 10 ベース部 11a… スライド部材 12a… アーム部材 13a… 昇降部材 15 X方向移動部 16 Y方向移動部 17 Z方向移動部 18 回動アーム 19 駆動ユニット 20… 直動アクチュエータ 21ax… アウタチューブ 22ax… インナワイヤ M 搾乳ロボット H… 乳頭 Ta… ティートカップ[Description of Signs] 1 Automatic milking machine 2 End effector 3 Manipulator 4a ... Displacement drive mechanism 5ax ... X-direction displacement 5ay ... Y-direction displacement 5az ... Z-direction displacement 5a ... Displacement mechanism 6ax ... Drive 6ay ... Drive Unit 6az Drive unit 7ax Remote control transmission unit 7ay Remote control transmission unit 7az Remote control transmission unit 10 Base unit 11a Slide member 12a Arm member 13a Lifting member 15 X direction moving unit 16 Y direction moving unit Part 17 Z-direction moving part 18 Rotating arm 19 Drive unit 20 Linear actuator 21ax Outer tube 22ax Inner wire M Milking robot H Nipple Ta Teat cup

───────────────────────────────────────────────────── フロントページの続き (72)発明者 岩崎 栄一 東京都港区赤坂2丁目3番6号 コマツエ ンジニアリング株式会社内 (72)発明者 太田 哲郎 長野県須坂市大字幸高246番地 オリオン 機械株式会社内 ──────────────────────────────────────────────────続 き Continued on the front page (72) Eiichi Iwasaki, 2-3-6 Akasaka, Minato-ku, Tokyo Komatsu Engineering Co., Ltd. In company

Claims (9)

【特許請求の範囲】[Claims] 【請求項1】 乳頭に対応した複数のティートカップを
支持するエンドエフェクタと、このエンドエフェクタを
移動させるマニピュレータと、前記エンドエフェクタに
対して各ティートカップをそれぞれ変位させる複数の変
位駆動機構部を有することにより、前記ティートカップ
を前記乳頭に自動で装着する搾乳ロボットを備える自動
搾乳機において、前記エンドエフェクタに、ティートカ
ップをX方向,Y方向及びZ方向へ変位自在に支持する
X方向変位部,Y方向変位部及びZ方向変位部を有する
変位機構部を設けるとともに、前記エンドエフェクタ以
外の部位に、前記X方向変位部,Y方向変位部及びZ方
向変位部の全部(又は一部)に対応した駆動部を設け、
当該駆動部と対応するX方向変位部,Y方向変位部及び
Z方向変位部の全部(又は一部)を、遠隔操作用伝達部
を介して接続した変位駆動機構部を備えることを特徴と
する自動搾乳機。
An end effector for supporting a plurality of teat cups corresponding to a teat, a manipulator for moving the end effector, and a plurality of displacement drive mechanisms for respectively displacing each teat cup with respect to the end effector. Thereby, in the automatic milking machine including the milking robot that automatically attaches the teat cup to the teat, the end effector includes an X-direction displacement unit that supports the teat cup so as to be displaceable in the X, Y, and Z directions. A displacement mechanism having a Y-direction displacement portion and a Z-direction displacement portion is provided, and all (or a part) of the X-direction displacement portion, the Y-direction displacement portion, and the Z-direction displacement portion are provided at a portion other than the end effector. Provided a driving unit,
A displacement drive mechanism is provided in which all (or a part of) the X-direction displacement unit, the Y-direction displacement unit, and the Z-direction displacement unit corresponding to the drive unit are connected via a remote operation transmission unit. Automatic milking machine.
【請求項2】 前記X方向変位部は前記エンドエフェク
タのベース部にスライド自在に設けることによりX方向
に変位するスライド部材を有することを特徴とする請求
項1記載の自動搾乳機。
2. The automatic milking machine according to claim 1, wherein said X-direction displacement portion has a slide member displaced in the X direction by being slidably provided on a base portion of said end effector.
【請求項3】 前記Y方向変位部は前記スライド部材に
後端部を回動自在に設けることにより前端部がY方向に
変位するアーム部材を有することを特徴とする請求項1
又は2記載の自動搾乳機。
3. The Y-direction displacement section includes an arm member whose front end is displaced in the Y direction by providing a rear end of the slide member rotatably.
Or the automatic milking machine according to 2.
【請求項4】 前記Z方向変位部は前記アーム部材の前
端部に昇降自在に設けることによりZ方向に変位する昇
降部材を有し、この昇降部材により前記ティートカップ
を支持することを特徴とする請求項1又は3記載の自動
搾乳機。
4. The apparatus according to claim 1, wherein the Z-direction displacement portion has a lifting member which is displaceable in the Z direction by being provided at a front end of the arm member so as to be movable up and down, and the teat cup is supported by the lifting member. The automatic milking machine according to claim 1.
【請求項5】 前記遠隔操作用伝達部は伝達方向に対し
て位置を固定したアウタチューブと、このアウタチュー
ブの内部にスライド自在に挿通し、かつ伝達方向に剛性
を有するインナワイヤを有することを特徴とする請求項
1記載の自動搾乳機。
5. The remote control transmission section includes an outer tube fixed in position in the transmission direction, and an inner wire slidably inserted into the outer tube and having rigidity in the transmission direction. The automatic milking machine according to claim 1, wherein
【請求項6】 前記マニピュレータはエンドエフェクタ
をX方向,Y方向及びZ方向に移動させるX方向移動
部,Y方向移動部及びZ方向移動部を備えることを特徴
とする請求項1記載の自動搾乳機。
6. The automatic milking apparatus according to claim 1, wherein the manipulator includes an X-direction moving unit, a Y-direction moving unit, and a Z-direction moving unit for moving the end effector in the X, Y, and Z directions. Machine.
【請求項7】 前記Y方向移動部は前端部がY方向に移
動する回動アームを備え、この回動アームの後端部を前
記X方向移動部及び前記Z方向移動部により移動可能に
支持するとともに、当該回動アームの前端部に前記エン
ドエフェクタを支持することを特徴とする請求項6記載
の自動搾乳機。
7. The Y-direction moving unit includes a pivot arm whose front end moves in the Y direction, and a rear end of the pivot arm is movably supported by the X-direction moving unit and the Z-direction moving unit. 7. The automatic milking machine according to claim 6, wherein the end effector is supported on a front end of the rotating arm.
【請求項8】 前記回動アームの後端部と一体に移動
し、かつ前記駆動部を収容した駆動ユニットを備えるこ
とを特徴とする請求項1又は6記載の自動搾乳機。
8. The automatic milking machine according to claim 1, further comprising a drive unit that moves integrally with a rear end of the rotating arm and houses the drive unit.
【請求項9】 前記駆動部は直動アクチュエータを用い
ることを特徴とする請求項1又は8記載の自動搾乳機。
9. The automatic milking machine according to claim 1, wherein the drive unit uses a linear actuator.
JP8197732A 1996-07-26 1996-07-26 Automatic milking machine Pending JPH1033079A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP8197732A JPH1033079A (en) 1996-07-26 1996-07-26 Automatic milking machine

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP8197732A JPH1033079A (en) 1996-07-26 1996-07-26 Automatic milking machine

Publications (1)

Publication Number Publication Date
JPH1033079A true JPH1033079A (en) 1998-02-10

Family

ID=16379429

Family Applications (1)

Application Number Title Priority Date Filing Date
JP8197732A Pending JPH1033079A (en) 1996-07-26 1996-07-26 Automatic milking machine

Country Status (1)

Country Link
JP (1) JPH1033079A (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010502181A (en) * 2006-09-05 2010-01-28 マースランド エヌ・ヴィ Automatic milking equipment for livestock

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010502181A (en) * 2006-09-05 2010-01-28 マースランド エヌ・ヴィ Automatic milking equipment for livestock
US8807080B2 (en) 2006-09-05 2014-08-19 Maasland N.V. Implement for automatically milking a dairy animal
US10039259B2 (en) 2006-09-05 2018-08-07 Maasland N.V. Implement for automatically milking a dairy animal
US10743512B2 (en) 2006-09-05 2020-08-18 Maasland N.V. Implement for automatically milking a dairy animal
US10750712B2 (en) 2006-09-05 2020-08-25 Maasland N.V. Implement for automatically milking a dairy animal

Similar Documents

Publication Publication Date Title
JP7103689B2 (en) Autonomous mobile transfer robot
US8189867B2 (en) Learning method for article storage facility
CN100421626C (en) Parallel-link table and X-ray tomographic imaging apparatus
CN111331367A (en) Intelligent assembly control system
CN109091233B (en) Puncture surgical robot based on series-parallel connection structure
CN102724914A (en) Mobile base and x-ray machine mounted on such a mobile base
WO1996020587A1 (en) Method and device for positioning teat cups
JPH09285234A (en) Bovine body position detector in automatic milking machine
JP7180906B2 (en) Autonomous mobile transfer robot and its chuck and operating mechanism
JPH09275834A (en) Teat position detector for automatic milking machine
JPH08263137A (en) Autonomous traveling vehicle
CN108789435B (en) Multifunctional voice control service robot
WO2006036669A1 (en) Motion control device for wire bonder bondhead
US20130028388A1 (en) Fluoroscopic x-ray apparatus
JPH1033079A (en) Automatic milking machine
JPS6356233A (en) Milker for animal
CN111571562B (en) Operating room apparatus nurse robot
JPH1033080A (en) Attachment of teat cup of automatic milking machine
CN101431040B (en) Lifter structure
JPS5878635A (en) Endoscope apparatus
JP3013155B2 (en) Automatic milking machine
JP2001128577A (en) Apparatus for moving milking robot
JP3357461B2 (en) Control device for position and angle of stereoscopic imaging device
JP7209680B2 (en) Die bond head device with die holder motion table
JP3225353B2 (en) Nipple position detection device of automatic milking machine