Ultrasonic detector, methods for searching a moving object, ultrasonic sensor unit, element for positioning an animal, terminal apparatus for an automatic milking system, and method for automatically milking an animal.

0001A primary aspect of the present invention relates to an ultrasonic detector.

0002Ultrasonic detector equipment for automatic milking devices is described in the European patent application 232.568 from the same applicant. A problem in this known system is the obtaining of a detection field that is accurately determined with respect to height, while in the plane defined by the height the wides possible bundle has to be generated in order to be able to search for, find and/or approach a cow udder provided with a teat.

0003An ultrasonic detector according to claim 1 has for its object to improve upon the known prior art. Further this ultrasonic detector solves the above problem.

0004A further aspect of the present invention relates to a method for searching a moving object.

0005Existing robot systems, such as published in EP-A-232568, EP-A-213660 and EP-A-209202, for seeking, finding and/or following a (moving) object forming part of a greater entity have been found to be incapable of meeting requirements in respect of reliability, speed and/or possibilities for error correction.

0006This further aspect of the present invention has for its object to improve upon the above mentioned prior art. Further it is an object of the present invention to obviate the above mentioned drawbacks.

0007By making use, as in accordance with the method of claim 13, of position and speed information, a more accurate determining of position is achieved and information is obtained related to the pattern of movement of the (moving) object; information concerning speed in the case of violent movements will also be available.

0008With the method according to claim 14 information is obtained concerning errors and/or other irregularities either in the measuring process or the control process or in the movements of the object.

0009A further aspect of the present invention relates to an ultrasonic sensor unit.

0010Ultrasonic sensor units are much used in industrial and agrarian environments as they are not very sensitive to dirt and are robust.

0011Ultrasonic sensor units for use in agriculture are described in the European patent applications EP-A-0 213 660, EP-A-0 232 568 and EP-A-0 270 165.

0012The above publications all describe sensors for use in automatic milking devices, and more specifically for seeking and following the udder and/or teat of a cow.

0013The present invention relates to an ultrasonic sensor unit as according to claim 25.

0014By moving the transducer relative to an ultrasonic mirror the area for scanning is varied, for example made larger or smaller. Thus for example in the case of the conical reflection surface, this conical reflection surface can be moved down or upward so that a narrower or wider bundle results.

0015In preference however the sensor unit in accordance with claims 26 and/or 27 is employed so that it becomes possible to scan an area around the transducer and by moving the mirror only through a determined angle or by stopping the rotating ultrasonic mirror, to scan a more or less restricted circle segment. In order to follow a particular teat the reflection surface will often be brought to a stop.

0016A further aspect of the present invention relates to an element for positioning an animal.

0017Such an element is to be used especially in an automatic milking system in which it is important to position an animal in an exactly defined position before automatically applying teat cups.

0018Another aspect of the present invention relates to a terminal apparatus to be used at an automatic milking system, in which a farmer can easily control functions of the milking system.

0019Furthermore, yet another aspect of the present invention relates to a method for automatically applying teat cups.

0020Further advantages, features and details of the present invention will be clearified with reference to a drawing in which: <ul id="ul0001" list-style="none"><li>fig. 1 shows a perspective view of an automatic milking device, in which an ultrasonic detector according to the present invention is employed;</li><li>fig. 2 shows a schematic, perspective view of detail II from fig. 1;</li><li>fig. 3 shows detail III from fig. 2;</li><li>fig. 4 shows a side view from the line IV-IV from fig. 3; and</li><li>fig. 5 shows detail V from fig. 1.</li><li>fig. 6 shows a perspective view of a robot system for implementation of a part of a preferred embodiment of the method according to the invention;</li><li>fig. 7 shows a block diagram of the operation of the robot system from fig. 6;</li><li>fig. 8 shows a block diagram of another preferred operation of the robot system from fig. 7;</li><li>fig. 9 shows a perspective, partly broken away and partly schematic view of an automatic milking device provided with a preferred embodiment of an ultrasonic sensor unit according to the present invention;</li><li>fig. 10 shows the sensor unit, in more detail, beneath the udder of a cow;</li><li>fig. 11 shows another preferred embodiment of the ultrasonic sensor unit according to the present invention;</li><li>fig. 12 shows a section along the line XI-XI from fig. 11.</li><li>fig. 13 shows a perspective view of an arrangement for automatically applying teat cups to cows;</li><li>fig. 14 shows a perspective view of detail XIV of fig. 13;</li><li>fig. 15 shows a perspective view of detail XV of fig. 13;</li><li>fig. 16 shows a perspective view of a terminal apparatus to be used at a milking system of fig. 13;</li><li>fig. 17 shows a top view of detail XVII of fig. 16;</li><li>fig. 18 shows in more detail detail XVIII of fig. 16;</li><li>fig. 19A and 19B show respective perspective views of a detection arrangement for automatically applying teat cups into respective positions; and</li><li>fig. 20 a top view of a positioned cow.</li></ul>

0021Mounted on the milking rack 2 are four milking cups 9, as described in EP-A-232.568. A gripper member 10 of the milking robot 1 grips onto the milking rack 2 and can move it three-dimensionally.

0022The arranged above the milking cups 9 is a sensor assembly 12 which comprises two (or more) lying ultrasonic transmitter/receiver units 13 and 14 - per se known - and arranged above them the respectived cones 15 and 16 (fig. 2), preferably made of plastic. An example of signal processing of signals coming from ultrasonic sensors is described in EP-A-232.568.

0023Present in a housing 17 for the sensors is a space 18 for accommodation of the electronics, these electronics being connected in a manner not shown to a central control unit. The cones 15, 16 and the housing 17 are preferably of aluminium or plastic - the cone surfaces polished smooth - so that the transmitter/receiver unit is robust, dirt-resistant and cannot rust.

0024If the transmitter/receiver units 13 and 14 are disposed at a mutual angle α of for example 50°, a detection field is created whereby one teat can be located without the sensor units 'hearing' one another's detection field; in order to avoid this cross over a screen 19 of sound-damping material can be attached to housing 17.

0025It is also possible to use transmitting member and two or more receiving members at the same time. In this case it is also possible to scan two teats simultaneously.

0026In the preferred embodiment shown the cone pieces 15, 16 are mounted on the housing, for instance with adhesive.

0027Bundles of ultrasonic waves transmitted and received as according to arrows A by a transmitter/receiver unit 13 (fig. 3, 4) form a broad bundle as indicated with the arrows C. The half top angle of the cone amounts preferably to roughly 35°, while the cone is preferably disposed in slightly forward inclined position so that a generatrix G of the cone surface makes an angle of approximately 45° with the transmitter/receiver unit 13.

0028Through variation of the half top angle of the cone and/or the distance between the cone and the sensor, the area and/or shape of the field can be adjusted.

0029The detection field will be rather flat and have the shape of a projection of a cigar.

0030If there is a slight deviation from the cone shape, for instance a generatrix G' has a slightly concave form, the height of the detection field - the direction between the bundle lines C - can thus be set.

0031By variation of the angle γ the principal direction of the field can be adjusted to the position of the sensor.

0032Via a piston rod 30 (fig. 5) a top piece 31 of the milking cup 9 can automatically be moved upward, while the position of a milking cup relative to a teat 20' can be corrected using ultrasonic transmitter/receiver units 32 arranged close to at least one milking cup. The ultrasonic waves are thereby directed against an ultrasonic mirror surface 33 to a point of intersection C where the teat has to be located in order to be able to place the top piece 31 around it in the correct manner. The mirror surface 33 consists in preference of a conical surface as shown in the fig. 3 and 4, whereby however a generatrix has a slightly convex form in order to obtain a bundle that is also broadened in height. With particular embodiments such a transmitter/receiver unit 32 may be omitted, for example in the case of an embodiment in which use is made of three sensor units, as indicated with 13, 14.

0033The present invention is not limited to the above described embodiment, in which an integrated transmitter/ receiver unit is applied. The reflection surfaces can also be employed both in the case of a separate receiver and a separate ultrasonic transmitter.

0034A further preferred embodiment relates to a method and robot system for the milking of a cow (not shown in fig. 6). A robot system 41 comprising a number of arms pivotable relative to each other is movable along rails 47, 48 so as to be capable of performing search, find and/or following operations in different locations for the arranging of milking cups 45 of a milking rack 42 on a cow. The cow is directed with its head in the direction of a feed bin 61 so that its udder will be situated in the vicinity of a rest or start position of milking rack 42; a feed bin 61 can be moved in accordance with arrow A so that the udder of the cow will usually be located in roughly the same or nomal position relative to the milking rack 42, independently of the length of the cow.

0035The cow will usually be recognised automatically and information concerning its udder and teats will be available for instance in a central control means (not shown) provided with electronic hardware having software stored therein; from an energising member in cabinet 62 a mechanism 51 is driven (in a manner not shown) along upright rails 65, 66 so that the rest position of mechanism 51, and therefore of milking set 42, is pre-adjusted as far as possible subject to the size of the cow and the position of its udder. Further, movement in upward direction is limited. Irrespective of the cow the mechanism 51 is set along the lying rails 63, 64 in a standard or fixed lengthwise rest position. Also driven from the electronics cabinet 62 is an actuator 46 which controls via a lever 45 two Bowden cables which pull an arm to which the milking rack 42 is attached into a predetermined rest or zero position.

0036Fixed to milking rack 42 and to the side of it is a sensor unit or assembly 52 for the purpose of detecting, with the aid of two sensor units 53 and 54, a moving object, in the preferred embodiment shown a teat of a cow, in three dimensions in a lying plane and passing on information related thereto to a central control means (not shown). Additional sensor units 69, 71 can be disposed above each milking cup 55 of the milking set 42 in order to keep a teat centred relative to a milking cup as the milking cups move upward; for the sake of clarity such fine sensor units 69, 71 are only shown disposed by one milking cup 55. Like the sensor unit 52 these fine sensor units can be of an ultrasonic type.

0037A gripper member 50 of the robot 41 grips onto an opening of the milking rack 42 arranged for that purpose. The robot mechanism 41 is capable of moving the milking rack 42 in three dimensions, while the mechanism 51 can block changes of direction in vertical direction; the electrical and program controls of the mechanism 41 and mechanism 51 are coupled to one another in a manner not shown.

0038The operation of the robot system from fig. 6 is explained on the basis of the diagram from fig. 7 (and later on the basis of the diagram from fig. 8 ); the (moving) object, which in the shown preferred embodiment is the position of a teat of a cow, for example the teat at the front right-hand side of the cow, with respect to the relevant sensor, forms the input I for the sensors 52, 59, 71. The reflections measured by the ultrasonic sensors 52, 59, 71 are converted in generally known manner into sampled digital values in a lying plane, in fig. 7 indicated with Δx and Δy, these being relative position coordinates with respect to the sensors. Coming from the robot arm 41 are determined values x_p and y_p, these being coordinates of the robot with respect to the neutral position of the robot, whereby Δx and Δy - allowing for correction - must be added to them so that, as is indicated schematically in the figure, the value x_m and y_m result, these being the coordinates of the teat with respect to the neutral position of the robot. These values are corrected in a manner described later so that the values x_c and y_c - the so-called target coordinates - result, which can be fed to a block designated schematically with SC to give to the robot 41 a new position towards which the latter must move the milking set 42.

0039The values x_p and y_p on the one hand and Δx, Δy on the other are incorporated in a MODEL - which in the simplest case does not subject these said values to any processing whatever, i.e. it is transparent - whereby after statistical analysis, comprising for instance the determining of the mean or the standard deviation, a number of M values are filtered out from a series of N values (M &lt; N). On the basis of the (modulated) values a prediction (PRE) can be made which is added to the controlling of the sensors in order to allow this PRE value to take the place of clearly erroneous values from the series of digitalized measurement values, in accordance with a predetermined criterion. In the MODEL a Z-transformation takes place of the digitalized samplings in the case of the described embodiment, but such a MODEL can likewise be implemented with a so-called Kallman filter or in other manner In FPC filter coefficients are determined in order to attribute a new value to the value x_m and y_m in PF on the basis of the MODEL as well as to the value v_xm - after differentiation in D of the values x_m and y_m - in order to add this filtered value (v_xf, v_yf) after integration in (I) to the corrected filter value x_f and y_f.

0040The described control loop of Δx, Δy via x_c, x_y to x_s, y_s is either closed or not on the basis of the data from the MODEL, as passed on to a block CONTROL; only when predetermined criteria have been fulfilled with respect to mean value of Δx over a determined time, mean value of Δy over a determined time, standard deviations therein in addition to particular velocity values (v_x, v_y), is the control loop at S closed by a block designated FTL.

0041In the first instance the control loop at S remains opened since from a block F, in a manner generally known in robot control, a global positional control is performed of the robot system 41 to a teat of a cow using information stored in a memory. If the sensor unit 52 - sensor units 69, 71 are not used in these so-called find-modes - detects a moving object and predetermined criteria with respect to Δx, Δy, vx, vy and standard deviations thereof are satisfied, the control is taken over in a block T and the above criteria, which the above information must satisfy at an increased sampling speed, are made more stringent.

0042If the more stringent criteria are satisfied for a predetermined time, the control loop at S is closed and the values x_c and y_c are fed directly to the servo-control (SC). If required the filter coefficients computed from the MODEL can be replaced by filter coefficients provided from the control means (CONTROL), these coefficients having a fixed value for a determined time duration, after which the coefficient computation from the MODEL will determine the position to which the robot arm is sent. Computations in CONTROL are dependent on the mode of the system.

0043If for a predetermined time duration the criteria from block T are satisfied, the described control loop remains closed and block L takes over the controlling, whereby, as is indicated via line FS, it is possible to switch over to fine sensor units 69, 71 so that the position of the milking cup relative to the teat can be determined (still) more accurately using any required correction by the fine sensor units, and the relevant milking cup 55 can be arranged if for a predetermined time the teat remains centred with respect to the milking cup and therefore the sensor units.

0044After arrangement of the milking cup, a switch back is made to the T-mode until another teat of the cow is centred, following which this milking cup can also be arranged in the L-mode.

0045It will be apparent that in the case of unexpected movements of the (moving) object the described robot system will change over instantly from L-mode control to T-mode control or even to F-mode control.

0046A diagram of another preferred embodiment of the operation of the robot system from fig. 6 (fig. 8) requires no velocity filter and only the values Δx and Δy are hereby analyzed, while the MODEL forming is omitted. Prediction values are fed via block CONTROL to the sensor block 52, 69, 71.

0047It is further noted that the Z coordinate or height coordinate of the teat of the cow will usually be constant and in the embodiment shown will have a value that is fixed or determined by the CONTROL block. In the case of the embodiment shown in fig. 8 the filter coefficients are constant in a particular situation of the system (F-, T- or L-mode), but they have a different value for each situation.

0048Extensive analyses and evaluation of tests have shown that with sampling at 20 Hz of the signals from the sensor assembly 52 and sensor units 69, 71 an accurate model of the movements of a teat of a cow can be built up; the controlling of the robot arm via the servo-control takes place in the preferred embodiment shown every 5 msec. In view of the possibility of switching between different movement modes, this has been found in practice to be amply sufficient to be able to follow a teat of a cow and arrange or attach the milking cups in a precise manner.

0049A robot installation 101 (fig. 9) or similar installation for automatic arrangement of milking cups 102 on the udder of a cow and the subsequent removal of milk is described in the above mentioned patent applications of the same applicant. The pivotable robot arm 103 is automatically controllable using an ultrasonic sensor unit 106 as according to the present invention which is disposed centrally on a milking set 107.

0050Ultrasonic sensor assembly 106 (fig. 10) comprises an ultrasonic sensor unit 108 which transmits and receives ultrasonic waves in accordance with arrows A. Disposed above the ultrasonic transducer 108 is an ultrasonic mirror 109. This ultrasonic mirro 109 is arranged in a hollow tube 111 which can be driven using a gear transmission 112 by a schematically indicated electro-motor 113. A post or support 114 is in fixed connection to the milking set 107 and provided with terminals 116 and 117 for electrical connection of the transducer 108. The tube 111 is rotatable about post 114 via schematically indicated bearings 118, 119.

0051The electro-motor can be driven electrically such that the tube 111 and therfore the mirror 109 turn completely round and therefore a circular or control area around the transducer is scanned. This will be the case if the mutual positions of teats 121 of the udder 122 of a cow (not shown) have to be determined. If an udder or teat of a cow has to be traced from a position as shown in fig. 9, the tube 111 can for example only be turned by the electro-motor 113 back and forth through a limited angle, so that a limited control or circle segment is scanned, in which circle segment the udder or teat can be expected to be because of the known, determined position of the cow.

0052In the position shown in fig. 10 - a view from the hind side of the cow - the milking cup on the front righthand side of the milking set 107 is carried or pushed upward and the tube 111 will become virtually stationary relative to transducer 108 so that the teat 121 on the front righthand side of the udder 122 is continually detected by the ultrasonic transducer 108. If a deviation is detected in the correct position of the teat 121 relative to the cup 102 the milking rack 107 can usually be adjusted instantly as according to arrows B, this substantially two-dimensionally.

0053Another preferred embodiment of an ultrasonic sensor unit 126 (fig. 11) according to the present invention is attached using a one-piece spring 127 to a supporting construction 128 of a rack 129 for four milking cups which are omitted for the sake of clarity. Only the points of attachment 131 for the milking cups to a tray 132 are shown. The tray 132 is fixed for limited movement to the supporting construction 128 with springs 133 and screw bolts 140. The sensor unit 126 protrudes from the side between the milking cups (not shown). Using socket head screws 134 and slots 135 a housing 136, and with it an ultrasonic mirror 137, can be adjustably fixed in position relative to a connecting piece 138 and therefore the supporting construction 128. In addition an electro-motor 139 is fixed in position in the housing 136 with a screw bolt 141; a gear ring 143 connecting onto a driving gear wheel 142 and firmly joined to the ultrasonic mirror 137 is thus coupled in housing 136 to the electro-motor 139. Further disposed in the housing is an upward facing transducer 144 with a schematically indicated connection 146. The ultrasonic waves are transmitted as according to the dashed and dotted line C.

0054As can be seen in fig. 12 the ultrasonic mirror may take a form that is slightly concave in the standing direction, and in the lying direction (fig. 11) so that in addition to being reflected by the mirror the ultrasonic waves are also focused. If the ultrasonic bundle has to diverge, the ultrasonic mirror face can take a slightly convex form.

0055The electro-motors 113 and 139 preferably take the form of so-called step motors so that the position and the angular rotation of the ultrasonic mirror face are not measured or computed from the time of revolution, but the position is available directly at the output of the step motor.

0056In accordance with the embodiments of the present invention both distance and direction of a (moving) object relative to the fixed transducer are measured in simple manner.

0057In another preferred embodiment of an automatic milking system (fig. 13) a moveable robot arm 201 is used to service milking locations 202 where the cow is retained in exact positions by means of positioning elements 203 and moveable feeding containers 204.

0058A cow (fig. 20) is forced to stand still on her right hind paw by means of a solid bar 261 for pushing the weight of the cow to its other hind paw, such that an arm of a milking rack can be moved to the udder of the cow.

0059In more detail (fig. 14) it is to be seen that on the center of the milking rack 207 a rotating scanner 208 is installed and a detector unit 209 is disposed besides the milking rack.

0060A positioning element 203 (fig. 15) comprises preferably retaining surfaces 211 for retaining the hind paws of a cow and inclided surfaces 212, 213 resp. to prevent the cow from moving her paws from the retaining surfaces in sideward and forward direction, resp. The hind part of the positioning element is provided with bars 214, 215 which will prevent the cow from moving her paw in backward direction and will allow excerements of the cow to fall through. The sidewardly inclined surfaces 212 extend to a height approx. 70 mm above the ground level without providing a flat surface for the cow to stand on. This is however high enough to allow the robot arm to go to the udder of the cow. The length L is approximately 300 mm viz. approx. two times the length of a paw. Preferably the behind bar 215 has a higher distance from the ground than the bars 214, such as the cow to prevent to step backwardly.

0061An authomatic milking system, e.g. such as shown in fig. 13, is preferably controlled by means of a terminal control unit 221 (fig. 16) provided with a slot 222 for inserting a floppy disc, a screen 223 and a especially designed keyboard 224.

0062The keyboard 224 is preferably provided with functional keys such as 226, 227 and 228. Those groups are preferably in groups such as 229, 231 and 232 which contain keysetter functionally associeted. Key 226' will e.g. control, after pressing this key, the applying of teat cups to a cow.

0063As the cows will be provided with means for automatically recognizing them, a complete history of the cows can be stored in a memory, e.g. on a floppy disc.

0064The keyboard 224 can easily be designed from a standardly available keyboard, such as from a IBM or compatible computer. The farmer, however, will not be bothered by learning difficult codes, e.g. from three letters, by heart; as the function keys preferably are provided with pictrograms.

0065In the preferred embodiment of fig. 13, using a positioning element 203 and a feeding container adjustable relative to the length of the cow, the position of the udder and teat to be found are within a 'window' of approximately 30 x 40 cm². Tests in this respect were done and even in the situation that teat positions of cows were unknown to a computer before entering a milking location, the detection unit 209 (fig. 14, 19A, 19B) was able to pick up the position of a teat inside that 'window'.

0066Preferably the detector unit 209 consists of transducer 231, 232 resp. provided above conial surfaces 233, 234 resp., such that no dirt will fall on the transducing surfaces.

0067The robot arm will move the milk rack 236 to the 'window' or area in which the udder will be detected. Firstly the right teat T at the front will be searched, by moving the milk rack and sensor unit 209 up and down. At analyzing the sample data from the sensor unit 209 it can be established that this right front teat T has been found.

0068The size of the 'window' through which a sensor can 'look' can be changed dependent on the information received. Information from outside the 'window' can be disregarded.

0069Afterwards a rotating scanner 237 will take over controlling the position of the milking rack. This rotating scanner will then be under the udder in between the teats. Under control of this rotating scanner 237 the teat cups are connected to the teat one at the time, as described in the prior art.

0070When a teat cup is connected in the right way, this fact will be sensed by a sensor in a vacuum line of the milking system. Teat cups 238 are preferably provided with flexible skirts 239 such as to prevend the sucking of air from the environment, which would disturb the ultrasonic detector by means of units 209 and 237.

0071The sensor unit 237 is disposed to the milking rack through legs 241 connected to bearings 242, 243 resp., and can be moved up and down by means of an hydropneumatics cilinder 244.

0072A milking platform 246 as well as a connecting arm 247 are connected to the frame 248 of the milking rack by means of springs 249, 251 resp. In the unlikely event that the cow will put her right hindleg on the milking rack, this milking rack will give away and will be disconnected automatically.

0073In the preferred embodiment of fig. 19A and 19B a reflecting surface 251 of the unit 237 can be rotated with approximately 167 rpm. The sensor unit 237 further comprises encoding means 252 connected - not shown - to the computer, a electromotor 253, a gearing 254, pigeon wheel 256 and a crown wheel 257. Under the rotating mirror 251 a transducing surface 258 is disposed, from which also detected reflections are transmitted to data processing equipment of the computerized controlling unit (not shown). The transducer uses a frequency of approx. 400 kH, such that it is not disturbed by noise from the environment. Through the high revolution speed of the mirror a focussing effect for the mirror is achieved.