# US 2022/0411236 A1 · Gantry drive system, motor control system, and control method

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

- Number: US 2022/0411236 A1
- Document ID: US20220411236A1
- Status: Published application
- Kind: A1
- Application number: 17/865,816
- Filed: 2022-07-15
- Published: 2022-12-29
- Earliest claimed: 2021-06-29
- Assignees: Kabushiki Kaisha Yaskawa Denki
- Applicants: Kabushiki Kaisha Yaskawa Denki
- Inventors: Minoru KOGA; Shota KAWAHARA; Junichi ITO
- Web page: https://patentgrep.com/patent/US20220411236A1

## CPC

- B66C 13/30: Circuits for braking, traversing, or slewing motors
- B66C 11/24: with means for locating or sustaining the loads or trolleys in predetermined positions; Hay hoists
- B66C 13/46: Position indicators for suspended loads or for crane elements
- G05B 19/19: characterised by positioning or contouring control systems, e.g. to control position from one programmed point to another or to control movement along a programmed continuous path
- H02P 5/46: for speed regulation of two or more dynamo-electric motors in relation to one another
- G05B 2219/40293: Gantry, portal
- G05B 2219/45031: Manufacturing semiconductor wafers
- G05B 2219/50228: Synchronize two slides, portal gantry, raising, moving
- B66C: CRANES; LOAD-ENGAGING ELEMENTS OR DEVICES FOR CRANES, CAPSTANS, WINCHES, OR TACKLES ({specially adapted for lifting invalids A61G7/10;} rope, cable, or chain winding mechanisms, braking or detent devices therefor B66D; specially adapted for nuclear reactors G21)
- 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)
- H02P: CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS

## Abstract

A gantry drive system includes: a first motor configured to drive a driving object along a first axis; a second motor configured to drive the driving object along a second axis parallel with the first axis; and a motor control system configured to control the first and second motors. The motor control system includes a mode switch that performs a switching between a first control mode in which a position of the driving object on each of the first and second axes is individually controlled while reducing an inter-axis positional deviation between the first and second axes, and a second control mode in which a rotational state of the driving object is controlled while controlling a position of the driving object, based on detected positions of the driving object on the first and second axes.

## Claims

### Claim 1

A gantry drive system comprising:
a first motor configured to drive a driving object along a first axis;
a second motor configured to drive the driving object along a second axis parallel with the first axis; and
a motor control system configured to control the first and second motors,
wherein the motor control system includes a mode switch that performs a switching between a first control mode in which a position of the driving object on each of the first and second axes is individually controlled while reducing an inter-axis positional deviation between the first and second axes, the inter-axis positional deviation being a deviation between the position of the driving object on the first axis and the position of the driving object on the second axis, and a second control mode in which a rotational state of the driving object is controlled while controlling a position of the driving object, based on detected positions of the driving object on the first and second axes, and
the motor control system controls the first and second motors according to the control mode switched by the mode switch.

### Claim 2 (depends on 1)

The gantry drive system according to claim 1, wherein the mode switch switches the first and second control modes based on an evaluation value indicating a degree of rigidity of the driving object.

### Claim 3 (depends on 2)

The gantry drive system according to claim 2, wherein the mode switch performs a switching to the first control mode when the evaluation value exceeds a predetermined threshold value, and performs a switching to the second control mode when the evaluation value falls below the predetermined threshold value.

### Claim 4 (depends on 2)

The gantry drive system according to claim 2, wherein the motor control system further includes
a test controller configured to execute an initial setting control for the first and second motors to make the detected positions on the first and second axes follow a test target position, and
a rigidity evaluator configured to calculate the evaluation value based on the inter-axis positional deviation obtained during the execution of the initial setting control, and a difference between thrust commands to the first and second motors, respectively, when the inter-axis positional deviation is obtained.

### Claim 5 (depends on 1)

The gantry drive system according to claim 1, wherein the motor control system includes a first control device connected to the first motor, and a second control device connected to the second motor,
the first and second control devices are connected to each other for a communication,
in the first control mode, the first control device generates a command directed to the first motor based on the detected position on the first axis, and the second control device generates a command directed to the second motor based on the detected position on the second axis,
in the first control mode, at least one of the first and second control devices generates compensation values of the commands directed to the first and second motors based on the inter-axis positional deviation, and
in the second control mode, the first control device generates a command directed to the first and second motors based on the detected positions on the first and second axes, and the second control device generates a command directed to the first and second motors based on the inter-axis positional deviation.

### Claim 6 (depends on 5)

The gantry drive system according to claim 5, wherein
the first control device includes
a first individual controller configured to generate a first command directed to the first motor based on the detected position on the first axis and the inter-axis positional deviation, in the first control mode, and
a first cooperative controller configured to generate a translational thrust command directed to the first and second motors based on the detected positions on the first and second axes, in the second control mode, and
the second control device includes
a second individual controller configured to generate a second command directed to the second motor based on the detected position on the second axis and the inter-axis positional deviation, in the first control mode, and
a second cooperative controller configured to generate a rotational torque command directed to the first and second motors based on the inter-axis positional deviation, in the second control mode.

### Claim 7 (depends on 6)

The gantry drive system according to claim 6, wherein
the first individual controller operates the first motor based on the first command,
the first cooperative controller outputs the translational thrust command to the second control device, and operates the first motor based on the translational thrust command and the rotational torque command obtained from the second cooperative controller,
the second individual controller operates the second motor based on the second command, and
the second cooperative controller outputs the rotational torque command to the first control device, and operates the second motor based on the rotational torque command and the translational thrust command obtained from the first cooperative controller.

### Claim 8 (depends on 6)

The gantry drive system according to claim 6, wherein the first and second control devices control the first and second motors to make the driving object approach a target position, and reduce the inter-axis positional deviation, every predetermined period,
the first individual controller generates the first command and operates the first motor based on the first command, per the predetermined period, and
the second individual controller generates the second command and operates the second motor based on the second command, per the predetermined period.

### Claim 9 (depends on 6)

The gantry drive system according to claim 6, wherein the first and second control devices control the first and second motors to make the driving object approach a target position, and reduce the inter-axis positional deviation, every predetermined period,
per the predetermined period, the first cooperative controller generates and outputs the translational thrust command, and operates the first motor based on the translational thrust command and the rotational torque command which are generated in a previous period, and
per the predetermined period, the second cooperative controller generates and outputs the rotational torque command, and operates the second motor based on the translational thrust command and the rotational torque command which are generated in the previous period.

### Claim 10 (depends on 6)

The gantry drive system according to claim 6, wherein the first individual controller acquires a position command indicating a target position of the driving object, and generates the first command so as to reduce a deviation between the detected position on the first axis and the position command, and reduce the inter-axis positional deviation, and
the second individual controller acquires the position command, and generates the second command so as to reduce a deviation between the detected position on the second axis and the position command, and reduce the inter-axis positional deviation.

### Claim 11 (depends on 6)

The gantry drive system according to claim 6, wherein the first cooperative controller acquires a position command indicating a target position of the driving object, and generates the translational thrust command so as to reduce a deviation between an average value of the detected positions on the first and second axes and the position command, and
the second cooperative controller generates the rotational torque command so as to reduce the inter-axis positional deviation.

### Claim 12

A motor control system comprising:
a controller configured to control a first motor that drives a driving object along a first axis, and a second motor that drives the driving object along a second axis parallel with the first axis; and
a mode switch configured to perform a switching between a first control mode in which a position of the driving object on each of the first and second axes is individually controlled while reducing an inter-axis positional deviation between the first and second axes, the inter-axis positional deviation being a deviation between the position of the driving object on the first axis and the position of the driving object on the second axis, and a second control mode in which a rotational state of the driving object is controlled while controlling a position of the driving object, based on detected positions of the driving object on the first and second axes,
wherein the controller controls the first and second motors according to the control mode switched by the mode switch.

### Claim 13

A control method comprising:
controlling a first motor that drives a driving object along a first axis, and a second motor that drives the driving object along a second axis parallel with the first axis; and
performing a switching between a first control mode in which a position of the driving object on each of the first and second axes is individually controlled while reducing an inter-axis positional deviation between the first and second axes, the inter-axis positional deviation being a deviation between the position of the driving object on the first axis and the position of the driving object on the second axis, and a second control mode in which a rotational state of the driving object is controlled while controlling a position of the driving object, based on detected positions of the driving object on the first and second axes,
wherein the controlling the first and second motors includes controlling the first and second motors according to a switched control mode.

### Claim 14 (depends on 13)

A non-transitory computer-readable storage medium having stored therein a program that causes a computer to execute the control method according to claim 13.
