# US 2025/0153362 A1 · Device for acquiring position of workpiece, control device, robot system, and method

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2025/0153362 A1
- Document ID: US20250153362A1
- Status: Published application
- Kind: A1
- Application number: 18/835,080
- Filed: 2022-02-15
- Published: 2025-05-15
- Earliest claimed: 2022-02-15
- Assignees: Fanuc Corporation
- Applicants: Fanuc Corporation
- Inventors: Jun WADA
- Web page: https://patentgrep.com/patent/US20250153362A1

## CPC

- B25J 9/1697: {Vision controlled systems}
- B25J 9/1679: {characterised by the tasks executed}
- G05B 2219/40564: Recognize shape, contour of object, extract position and orientation
- G05B 2219/45061: Measuring robot
- B25J: MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES ({manipulators specially adapted for use in surgery A61B34/70; manipulators used in cleaning hollow articles B08B9/04}; manipulators associated with rolling mills B21B39/20; manipulators associated with forging machines B21J13/10; {manipulators associated with picking-up and placing mechanisms B23P19/007}; means for holding wheels or parts thereof B60B30/00; {vehicles with ground-engaging propulsion means, e.g. walking members B62D57/02, B62D57/032; devices for picking-up and depositing articles or materials between conveyors B65G47/90, B65G47/91; manipulators with gripping or holding means for transferring packages B65H67/065}; cranes B66C; {manipulators used in the protection or supervision of pipe-line installations F17D5/00; walking equipment adapted for nuclear steam-generators F22B37/006}; manipulators specially adapted for, or associated with, nuclear reactors G21C; {apparatus used for handling wafers during manufacture or treatment of semiconductor H10P72/50})
- G05B: CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS (systems for controlling or regulating non-electric variables G05D; systems for regulating electric or magnetic variables G05F; control devices or systems insofar as characterised by mechanical features only G05G)

## Abstract

A device includes a model acquisition unit that acquires a workpiece model representing a modeled workpiece; a partial model generation unit that generates, using the workpiece model acquired by the model acquisition unit, a partial model representing a limited part of the workpiece model; and a position acquisition unit that matches the partial model generated by the partial model generation unit with shape data detected by a shape detection sensor to acquire the position, in a control coordinate system, of the portion of the workpiece corresponding to the partial model.

## Claims

### Claim 1

A device configured to acquire a position of a workpiece in a control coordinate system based on shape data of the workpiece detected by a shape detection sensor arranged at a known position in the control coordinate system, the device comprising:
a model acquiring unit configured to acquire a workpiece model modeling the workpiece;
a partial model generating unit configured to generate a partial model obtained by limiting the workpiece model to a part thereof, using the workpiece model acquired by the model acquiring unit; and
a position acquiring unit configured to acquire a first position in the control coordinate system of a portion of the workpiece corresponding to the partial model, by matching the partial model generated by the partial model generating unit with the shape data detected by the shape detection sensor.

### Claim 2 (depends on 1)

The device of claim 1, wherein the partial model generating unit is configured to generate a plurality of the partial models obtained by limiting the workpiece model to a plurality of the parts respectively.

### Claim 3 (depends on 2)

The device of claim 2, wherein the partial model generating unit is configured to generate:
a first partial model obtained by limiting the workpiece model to a first part; and
a second partial model obtained by limiting the workpiece model to a second part separated from the first part.

### Claim 4 (depends on 2)

The device of claim 2, wherein the partial model generating unit is configured to generate the plurality of partial models obtained by limiting the workpiece model to the plurality of parts by dividing an entirety of the workpiece model into the plurality of parts.

### Claim 5 (depends on 2)

The device of claim 2, wherein the position acquiring unit is configured to:
obtain a coincidence degree between the partial model and the shape data; and
determine whether or not the partial model matches the shape data by comparing the obtained coincidence degree with a predetermined threshold value, and
wherein the device further includes a threshold value setting unit configured to individually set the threshold value for each of the plurality of partial models.

### Claim 6 (depends on 1)

The device of the claim 1, further comprising a range setting unit configured to set a limit range for limiting to the part, with respect to the workpiece model,
wherein the partial model generating unit is configured to generate the partial model by limiting the workpiece model to the part in accordance with the limit range set by the range setting unit.

### Claim 7 (depends on 6)

The device of claim 6, wherein the range setting unit is configured to set the limit range based on a detection range in which the shape detection sensor detects the workpiece.

### Claim 8 (depends on 6)

The device of claim 6, further comprising a first input reception unit configured to receive an input for defining the limit range,
wherein the range setting unit is configured to set the limit range in accordance with the input received by the first input reception unit.

### Claim 9 (depends on 8)

The device of claim 8, further comprising an image data generating unit configured to generate image data of the partial model generated by the partial model generating unit,
wherein the first input reception unit receives, through the image data generated by the image data generating unit, the input for changing or canceling the limit range set by the range setting unit, or the input for causing the range setting unit to additionally set a new limit range.

### Claim 10 (depends on 6)

The device of claim 6, wherein the range setting unit is configured to set a first limit range for limiting to a first part and a second limit range for limiting to a second part, with respect to the workpiece model, and
wherein the partial model generating unit is configured to:
generate a first partial model by limiting the workpiece model to the first part in accordance with the first limit range set by the range setting unit; and
generate a second partial model by limiting the workpiece model to the second part in accordance with the second limit range set by the range setting unit.

### Claim 11 (depends on 10)

The device of claim 10, wherein the range setting unit is configured to:
set the first limit range and the second limit range such that boundaries thereof coincide with each other;
set the first limit range and the second limit range so as to be separated from each other; or
set the first limit range and the second limit range so as to partially overlap each other.

### Claim 12 (depends on 1)

The device of claim 1, further comprising a feature extracting unit configured to extract a feature point of the workpiece model used for the matching by the position acquiring unit,
wherein the partial model generating unit is configured to generate the partial model by limiting the workpiece model to the part so as to include the feature point extracted by the feature extracting unit.

### Claim 13 (depends on 12)

The device of claim 12, wherein the partial model generating unit is configured to limit the workpiece model to the part so as to include a plurality of the feature points, the number of which is equal to or greater than a predetermined threshold value.

### Claim 14 (depends on 1)

The device of claim 1, wherein the position acquiring unit is configured to acquire a second position of the workpiece in the control coordinate system, based on the first position and a position of the partial model in the workpiece model.

### Claim 15 (depends on 14)

The device of claim 14, wherein the partial model generating unit is configured to generate a plurality of the partial models obtained by limiting the workpiece model to a plurality of the parts respectively, and
wherein the position acquiring unit is configured to:
acquire a plurality of the first positions in the control coordinate system of a plurality of the portions respectively corresponding to the plurality of partial models, by matching the plurality of partial models generated by the partial model generating unit with the shape data; and
acquire the second position based on each of the acquired first positions.

### Claim 16 (depends on 1)

The device of claim 1, further comprising:
an image data generating unit configured to generate image data of the partial model generated by the partial model generating unit; and
a second input reception unit configured to receive, through the image data generated by the image data generating unit, an input for permitting the position acquiring unit to use the partial model for the matching.

### Claim 17 (depends on 1)

A controller of a robot, comprising the device of claim 1.

### Claim 18 (depends on 17)

A robot system, comprising:
a shape detection sensor arranged at a known position in a control coordinate system, and configured to detect a shape of a workpiece;
a robot configured to carry out a predetermined work on the workpiece; and
the controller of claim 17,
wherein the controller is configured to control the robot so as to carry out the predetermined work based on the first position acquired by the position acquiring unit.

### Claim 19

A method of acquiring a position of a workpiece in a control coordinate system based on shape data of the workpiece detected by a shape detection sensor arranged at a known position in the control coordinate system, the method comprising:
acquiring, by a processor, a workpiece model modeling the workpiece;
generating, by the processor, a partial model obtained by limiting the workpiece model to a part thereof, using the acquired workpiece model; and
acquiring, by the processor, a position in the control coordinate system of a portion of the workpiece corresponding to the partial model, by matching the generated partial model with the shape data detected by the shape detection sensor.
