# US 8,093,856 B2 · Position control apparatus for numerically controlled machine > Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt - Number: US 8,093,856 B2 - Document ID: US8093856B2 - Status: Granted - Kind: B2 - Application number: 12/581,569 - Filed: 2009-10-19 - Published: 2010-05-06 - Granted: 2012-01-10 - Earliest claimed: 2008-10-31 - Assignees: Okuma Corporation - Inventors: Masashi Miyaji - Web page: https://patentgrep.com/patent/US8093856B2 ## CPC - G05B 19/404: characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia (G05B19/19, G05B19/41 take precedence) - 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 - G05B 2219/41403: Machine deformation estimator as function of commanded position - 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 In a position control apparatus that drives a feed-axis with a servomotor of a machine tool, the machine tool may be quickly accelerated or decelerated in a state where a machine structural member that supports and fixes a structural member including a driving system has a lower rigidity, or in a state where an element having a lower rigidity is present beyond a load position where the detection by a linear scale is performed. In such cases, a generated deflection may induce a displacement in a mechanical system. A relative locus error may be generated between a workpiece to be processed and a front end portion of the tool. Further, a mechanism rigidity generally changes according to a machine posture. The generated deflection amount changes in magnitude. The present embodiment estimates and compensates a displacement amount of the front end portion of the tool that may be caused by the deflection of the mechanical system. Moreover, in calculating an estimation amount, the present embodiment can change a parameter corresponding to the mechanism rigidity based on the machine posture. Thus, the front end of the tool can move accurately along a desired locus relative to the workpiece to be processed. ## Claims ### Claim 1 A position control apparatus that is usable in a case where a motor drives a movable portion of a numerically controlled machine to change a relative positional relationship between two control objects provided on the numerically controlled machine, wherein the position control apparatus controls the position of the movable portion based on a position command value of the motor that is input from a host apparatus, the position control apparatus comprising: a machine deflection amount estimation unit that calculates a machine deflection amount estimation value representing a relative displacement amount between the two control objects that may be caused by a deflection of a structural member intervening between the two control objects based on information indicating a posture of the intervening structural member and information indicating a driving acceleration of the movable portion; a machine deflection compensation amount calculation unit that calculates a machine deflection position compensation value based on the machine deflection amount estimation value for compensating at least a positional deviation that may be caused by a deflection of the intervening structural member; and a command value calculation unit that generates a new position command value for the control by adding the machine deflection position compensation value to the position command value. ### Claim 2 (depends on 1) The position control apparatus according to claim 1, wherein the information indicating the posture of the intervening structural member is a machine coordinate value of the movable portion in each axial direction, and the information indicating the driving acceleration of the movable portion is the position command value of the motor, wherein the machine deflection amount estimation unit comprises: a storage unit that stores acceleration proportional information that represents information for calculating an acceleration proportional coefficient of a machine deflection amount that changes according to the machine coordinate value of the movable portion in each axial direction; an acceleration proportional coefficient calculation unit that calculates the acceleration proportional coefficient of the machine deflection amount according to a present posture of the intervening structural member based on the machine coordinate value of the movable portion in each axial direction and the acceleration proportional information stored in the storage unit; two differentiators that calculate a command acceleration that corresponds to a second-order differential value of the position command value of the motor; and a multiplier that calculates the machine deflection amount estimation value by multiplying the acceleration proportional coefficient of the machine deflection amount with the command acceleration. ### Claim 3 (depends on 1) The position control apparatus according to claim 1, wherein at least one of the two control objects is disposed on the movable portion, and the machine deflection amount estimation unit calculates a deflection amount generated in a movable direction of the movable portion as the machine deflection amount estimation value. ### Claim 4 (depends on 1) The position control apparatus according to claim 1, further comprising: a calculation unit that calculates a speed command value using a position deviation amplifier that can amplify a differential value between the position command value of the motor and a position detection value; and a calculation unit that calculates a torque command value using a speed deviation amplifier that can amplify a differential value between the speed command value and a time-differential value of the position detection value, wherein the machine deflection compensation amount calculation unit calculates at least one of a machine deflection speed compensation value and a machine deflection torque compensation value in addition to the machine deflection position compensation value, and the command value calculation unit calculates a new speed command value for the control by adding the machine deflection speed compensation value to the speed command value in a case where the machine deflection speed compensation value is calculated, and further the command value calculation unit calculates a new torque command value for the control by adding the machine deflection torque compensation value to the torque command value in a case where the machine deflection torque compensation value is calculated. ### Claim 5 (depends on 1) The position control apparatus according to claim 1, where the machine deflection compensation amount calculation unit calculates the machine deflection position compensation value using a proportional compensator based on the input machine deflection amount estimation value, calculates a machine deflection speed compensation value using a differentiator and a proportional compensator, and calculates a machine deflection torque compensation value using two differentiators, an acceleration-torque conversion coefficient, and a proportional compensator, wherein position, speed, and torque compensation values are adjusted by changing setting values of the proportional compensators. ### Claim 6 (depends on 4) The position control apparatus according to claim 4, wherein the command value calculation unit calculates a new speed command value for the control by subtracting the machine deflection speed compensation value from the time-differential value of the position detection value that serves as a speed feedback value. ### Claim 7 (depends on 1) The position control apparatus according to claim 1, wherein the command value calculation unit calculates a new position command value for the control by subtracting the machine deflection position compensation value from the position detection value that serves as a position feedback value.