# US 2022/0035333 A1 · Method for generating movement path of tool

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

- Number: US 2022/0035333 A1
- Document ID: US20220035333A1
- Status: Published application
- Kind: A1
- Application number: 17/326,624
- Filed: 2021-05-21
- Published: 2022-02-03
- Earliest claimed: 2020-07-28
- Assignees: Mirle Automation Corporation
- Applicants: Mirle Automation Corporation
- Inventors: HAO-WEI YEN; MING-CHIH HSIAO; CHEN-YI LIN
- Web page: https://patentgrep.com/patent/US20220035333A1

## CPC

- G05B 19/402: characterised by control arrangements for positioning, e.g. centring a tool relative to a hole in the workpiece, additional detection means to correct position (G05B19/19 takes precedence)
- B23Q 15/24: of linear position
- G05B 19/4097: characterised by using design data to control NC machines, e.g. CAD/CAM (G05B19/4093 takes precedence)
- G05B 19/41: characterised by interpolation, e.g. the computation of intermediate points between programmed end points to define the path to be followed and the rate of travel along that path (G05B19/25, G05B19/31, G05B19/37, G05B19/39, G05B19/40 take precedence)
- G06F 30/20: Design optimisation, verification or simulation (optimisation, verification or simulation of circuit designs G06F30/30)
- 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)
- B23Q: DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING (tools of the kind used in lathes or boring machines B23B27/00); MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- G06F: ELECTRIC DIGITAL DATA PROCESSING (computer systems based on specific computational models G06N)

## Abstract

A method for generating a movement path of a tool configured to utilize a virtual path to generate a correct path that fits an allowable error is provided. The method includes a receiving step implemented by receiving the virtual path and a precision data; an auxiliary point establishing step implemented by adding a plurality of auxiliary points in a plurality of arc sections; a moving and detecting step implemented by controlling the tool to sequentially move to a plurality of predetermined points and the auxiliary points according to the virtual path; and a calculating step implemented by amending the predetermined points or the auxiliary points in the virtual path if a difference between a real-time position coordinate and corresponding one of the predetermined points or the auxiliary points is greater than the allowable error to generate the correct path.

## Claims

### Claim 1

A method for generating a movement path of a tool configured to utilize a virtual path to generate a correct path that fits an allowable error, wherein the virtual path is planned through a path planning software when the tool is to be moved in a space, the virtual path includes a plurality of predetermined points, and the method for generating the movement path of the tool is configured to be implemented by a processing device, the method comprising:
a receiving step implemented by receiving the virtual path and a precision data;
an auxiliary point establishing step implemented by defining the virtual path into at least one non-arc section and at least one arc section and defining the at least one arc section into M number of auxiliary sections according to the precision data to correspondingly generate M−1 number of auxiliary points, wherein a quantity of the auxiliary points included by the at least one arc section is greater than a quantity of the predetermined points included by the at least one arc section;
a moving and detecting step implemented by controlling a driver to allow the tool to sequentially move to each of the predetermined points and each of the auxiliary points in the space according to the virtual path and controlling a detector to detect three reflectors disposed on the tool when the tool is located at each of the predetermined points and each of the auxiliary points so as to generate a real-time position coordinate and two auxiliary point coordinates, wherein the real-time position coordinate and each of the auxiliary point coordinates include an X-axis coordinate value, a Y-axis coordinate value, and a Z-axis coordinate value;
a calculating step implemented by comparing each of a plurality of real-time position coordinates with a predetermined point coordinate that corresponds to a corresponding one of the predetermined points to calculate a deviating value of an X-axis, a deviating value of a Y-axis, and a deviating value of a Z-axis between each of the real-time position coordinates and the predetermined point coordinate and calculating, when the tool moves to each of the predetermined points, a deflecting value of the X-axis, a deflecting value of the Y-axis, and a deflecting value of the Z-axis of a coordinate system of the tool that are respectively compared with an X-axis, a Y-axis, and a Z-axis of a coordinate system of the virtual path, wherein each of the real-time position coordinates and corresponding two of the plurality of auxiliary point coordinates jointly define the X-axis, the Y-axis, and the Z-axis of the coordinate system of the tool; and
a correct path establishing step implemented by copying the virtual path to establish an original path, and amending the predetermined point coordinate and the two auxiliary point coordinates having the deviating value or the deflecting value greater than the allowable error in the original path to amend the original path into the correct path.

### Claim 2 (depends on 1)

The method according to claim 1, wherein the three reflectors are respectively defined as a first reflector, a second reflector, and a third reflector, wherein, before the receiving step, the method further includes a preparation step implemented by placing the three reflectors onto the tool, arranging the second reflector and the first reflector on a first axis, and arranging the third reflector and the first reflector on a second axis, wherein the first axis and the second axis are not parallel to each other, and wherein, in the moving and detecting step, the detector detects the first reflector to generate the real-time position coordinate, and the detector detects the second reflector and the third reflector to correspondingly generate the two auxiliary point coordinates.

### Claim 3 (depends on 2)

The method according to claim 2, wherein the first axis and the second axis are perpendicular to each other.

### Claim 4 (depends on 2)

The method according to claim 2, wherein, before the receiving step, the method further includes a coordinate system correction step implemented by controlling the tool to move, so that the first reflector is moved to a correction coordinate, and then controlling the detector to detect the first reflector to generate a detection coordinate, and in response to the detection coordinate not matching the correction coordinate, the tool is controlled to move until the detection coordinate matches the correction coordinate.

### Claim 5 (depends on 4)

The method according to claim 4, wherein, in the calculating step, the real-time position coordinate and the two auxiliary point coordinates are utilized to respectively calculate a first axis vector and a second axis vector of two of a plurality of axis directions in the coordinate system of the tool, the first axis vector and the second axis vector are utilized to calculate a third axis vector of the coordinate system of the tool, and the deflecting value of the first axis vector, the deflecting value of the second axis vector, and the deflecting value of the third axis vector respectively between the X-axis, the Y-axis, and the Z-axis of the coordinate system of the virtual path are calculated.

### Claim 6 (depends on 1)

The method according to claim 1, wherein a difference on the X-axis coordinate, a difference on the Y-axis coordinate, and a difference on the Z-axis coordinate of the two auxiliary point coordinates respectively corresponding to adjacent two of the auxiliary points are respectively less than a difference on the X-axis coordinate, a difference on the Y-axis coordinate, and a difference on the Z-axis of two predetermined point coordinates corresponding to adjacent two of the predetermined points of the at least one arc section.

### Claim 7 (depends on 1)

The method according to claim 1, wherein, in the auxiliary point establishing step, the processing device calculates a plurality of predetermined point coordinates corresponding to the predetermined points included by the virtual path, so as to utilize adjacent two of the predetermined point coordinates to calculate a radian of a sectional path connecting adjacent two of the predetermined points, and wherein in response to the radian being greater than a predetermined radian, the sectional path is determined as the at least one arc section, and in response to the radian being less than the predetermined radian, the sectional path is determined as the at least one non-arc section.

### Claim 8 (depends on 1)

The method according to claim 1, wherein, after the correct path establishing step, the method further includes a verifying step implemented by controlling the tool to move in the space along the correct path and repeatedly implementing the auxiliary point establishing step, the moving and detecting step, and the calculating step.
