SERVO CONTROLLER FOR CORRECTING POSITION ERROR WHEN MOVING MEMBER REVERSES

摘要

A servo controller (10) includes a reversal change calculating part (24) which uses the position of a moving member (19) as the basis to calculate the amount of change of the position of the moving member, a distance calculating part (25) which uses a position of the moving member as the basis to calculate a distance from the servo motor to the moving member, an approximation equation determining part (26) which uses the amount of change of the position of the moving member, distance, and the torque command as the basis to calculate a position correction amount which corrects delay of the servo motor due to reversal of the servo motor, and a position correction calculating part (27) which uses the approximation equation as the basis to calculate the position correction amount.

主权项

1. A servo controller which drives a threaded shaft of a ball screw which is connected to a servo motor so as to make a moving member which is engaged with said threaded shaft move,
said servo controller comprising: a motor position acquiring part which acquires a position of said servo motor every predetermined control period, a moving member position acquiring part which acquires a position of said moving member said every predetermined control period, a torque command preparing unit which prepares a torque command of said servo motor said every predetermined control period, a reversal change calculating part which uses a position of said moving member which was acquired by said moving member position acquiring part as the basis to calculate the amount of change of the position of said moving member, a distance calculating part which uses the position of said servo motor which was acquired by said motor position acquiring part or the position of said moving member which was acquired by said moving member position acquiring part as the basis to calculate a distance from said servo motor to said moving member, an approximation equation determining part which uses the amount of change of the position of said moving member which was calculated by said reversal change calculating part, the torque command which was prepared by said torque command preparing unit, and the distance which was calculated by said distance calculating part as the basis to determine an approximation equation for calculating a position correction amount which corrects delay of said servo motor due to reversal of said servo motor, and a position correction calculating part which uses the approximation equation which was determined by said approximation equation determining part as the basis to calculate said position correction amount.