Vision system for teat detection

Patent metadata

Field	Value
Publication number	US-10499607-B2
Application number	US-201715448761-A
Country	US
Kind code	B2
Filing date	Mar 3, 2017
Priority date	Aug 17, 2016
Publication date	Dec 10, 2019
Grant date	Dec 10, 2019

Abstract

A system includes a robotic arm, a laser, and a processor. The processor is configured to determine whether a distance between a left and right teat of a dairy livestock is less than or equal to a predetermined distance, and if so, command the robotic arm to move to a scan location that is between the left and right teats. The processor is further configured to command the laser to perform a scan of the teats after the robotic arm is at the scan location and to determine whether the left and right teats are found in the scan. If both the left and right teats are found in the scan, the processor commands the robotic arm to attach a teat cup to either the left or right teat.

First claim

The invention claimed is:

1. A vision system comprising:
a robotic arm that attaches a teat cup to a dairy livestock in a stall;
a laser that generates a plurality of profile signals, each profile signal comprising information associated with a relative distance between the laser and at least a portion of the dairy livestock;
one or more memory devices that stores historical teat location information for a plurality of teats of the dairy livestock; and
a processor communicatively coupled to the laser and the one or more memory devices, wherein the processor:
determines, from the historical teat location information, a first expected teat position associated with a first teat and a second expected teat position associated with a second teat;
determines a distance between the first expected teat position and the second expected teat position;
determines that the distance is less than or equal to a predetermined distance;
in response to determining that the distance is less than or equal to the predetermined distance, commands the robotic arm to move to a first location that is between the first expected teat position and the second expected teat position;
commands the robotic arm to move up a predetermined amount after the robotic arm moves to the first location;
commands the laser to perform a scan of the dairy livestock after the robotic arm moves up the predetermined amount;
accesses a first profile signal generated by the laser from the first scan;
determines that both first and second teats are found in the first profile signal; and
in response to determining that both first and second teats are found in the first profile signal, commands the robotic arm to attach the teat cup to the first or second teats.

2. The vision system of claim 1 , wherein the predetermined amount is less than or equal to 5 mm.

3. The vision system of claim 1 , wherein the predetermined distance is less than or equal to 5 cm.

4. The vision system of claim 1 , wherein the processor further:
in response to determining that both first and second teats are not found in the first profile signal, commands the robotic arm to move up the predetermined amount; and
commands the laser to perform the scan of the dairy livestock again.

5. The vision system of claim 1 , wherein the first location is equidistant between the first expected teat position and the second expected teat position.

6. The vision system of claim 1 , wherein the laser is coupled to the robotic arm.

7. The vision system of claim 1 , wherein the processor further:
in response to determining that the distance is not less than or equal to the predetermined distance, executes a different algorithm for attaching the teat cup to the dairy livestock.

8. One or more computer-readable non-transitory storage media comprising software that is operable when executed by one or more processors to:
determine that a distance between a first expected teat position and a second expected teat position is less than or equal to a predetermined distance, the first expected teat position associated with a first teat of a dairy livestock and the second expected teat position associated with a second teat of the dairy livestock;
in response to determining that the distance is less than or equal to the predetermined distance, command a robotic arm to move to a first location that is between the first expected teat position and the second expected teat position;
command the robotic arm to move up a predetermined amount after the robotic arm moves to the first location;
command a laser to perform a scan of the dairy livestock after the robotic arm moves up the predetermined amount;
determine that the first and second teats are found in the scan; and
in response to determining that the first and second teats are found in the scan, command the robotic arm to attach a teat cup to the first or second teats.

9. The one or more computer-readable non-transitory storage media of claim 8 , wherein:
the predetermined amount is less than or equal to 5 mm; and
the predetermined distance is less than or equal to 5 cm.

10. The one or more computer-readable non-transitory storage media of claim 8 , the software further operable when executed by the one or more processors to:
in response to determining that at least one of the first and second teats are not found in the scam, command the robotic arm to move up the predetermined amount; and
command the laser to perform the scan of the dairy livestock again.

11. The one or more computer-readable non-transitory storage media of claim 8 , wherein the first location is equidistant between the first expected teat position and the second expected teat position.

12. The one or more computer-readable non-transitory storage media of claim 8 , wherein the laser is coupled to the robotic arm.

13. The one or more computer-readable non-transitory storage media of claim 8 , the software further operable when executed by the one or more processors to:
in response to determining that the distance is not less than or equal to the predetermined distance, execute a different algorithm for attaching the teat cup to the dairy livestock.

Assignees

• Technologies Holdings Corp

Inventors

• Foresman Mark A
• Van Anart Marijn
• Van Der Sluis Peter Willem

Classifications

• A01J5/0175

  Attaching of clusters · CPC title

• A01J5/007 Primary

  Monitoring milking processes; Control or regulation of milking machines · CPC title

• A01J5/017

  Automatic attaching or detaching of clusters · CPC title