The invention relates to a method for controlling a motor in consideration of unbalance torque, a control device for carrying out the method and a machine tool provided with a tool magazine.
Patent Literature 1 describes a method for controlling a motor wherein the moment of inertia and the unbalance torque of a tool magazine are estimated based on the shapes and the distribution of the tools mounted to the tool magazine, and the optimum acceleration is determined by adding/subtracting the unbalance torque.
Patent Literature 1: JP-A-2005-224896
According to the invention of Patent Literature 1, the shapes and the distribution of the tools mounted to the tool magazine must be previously known, and therefore when an operator of the machine tool has replaced the tools, the acceleration/deceleration parameter cannot be automatically revised.
The invention is directed to solve the prior art problem, and the objective of the invention is to ensure the estimation of the unbalance torque in a rotating shaft apparatus in which the load torque is changed by moving unevenly distributed masses, whereby reducing the movement duration of the rotating shaft apparatus.
In order to achieve the above described object, according to the invention, a method of controlling a motor of a rotating shaft apparatus configured to rotate about a horizontal or inclined rotational axis, comprising the steps of positioning the rotating shaft apparatus at at least two rotational positions, measuring stopping load torque acting on the rotating shaft apparatus at each of the rotational positions, calculating unbalance torque which is the stopping load torque at one of the rotational positions where the stopping load torque is the maximum, based on the stopping load torques, and controlling the motor of the rotating shaft apparatus based on the unbalance torque is provided.
Further, according to the invention, an apparatus for controlling a motor of a rotating shaft apparatus configured to rotate about a horizontal or inclined rotational axis, comprising means for positioning the rotating shaft apparatus at at least two rotational positions, means for measuring stopping load torque acting on the rotating shaft apparatus at each of the rotational positions, and means for calculating unbalance torque which is the stopping load torque at one of the rotational positions where the stopping load torque is the maximum, based on the stopping load torques, whereby the motor of the rotating shaft apparatus is controlled based on the unbalance torque is provided.
According to the invention, the stopping load torques are measured, and the unbalance torque, which is the stopping load torque at one of the rotational positions where the stopping load torque is the maximum, is calculated, so that the motor of the rotating shaft apparatus is optimally controlled, based on the unbalance torque, whereby enabling to increase the driving speed of the rotating shaft apparatus, and reducing the sudden changes in the driving speed.
With reference to the drawings, a preferred embodiment of the invention will be described below.
With reference to
With reference to
The cover 130 comprises a partition 132 configured to divide the interior space of the cover into a processing chamber 134 and a tool accommodating chamber 136. The machine tool 100 is placed in the processing chamber for machining a workpiece, while the tool magazine and the tool changer 140 are placed in the tool accommodating chamber 136. The partition 132 defines an opening 132a allowing a tool to be transported between the processing chamber 134 and the tool accommodating chamber 136. The partition 132 is provided with a shutter 132b configured to open and close the opening 132a. The cover 130 defines an opening 138a for allowing an operator to access the tool accommodating chamber 136 to mount tools onto the tool magazine 120 and to remove tools from the tool magazine. The opening 138a is opened and closed by an ATC door 138b. New tools are mounted to the tool magazine 120, and used tools are removed from the tool magazine 120 by an operator of the machine tool 100, after opening the ATC door 138b of the cover 130, whereby the tools are exchanged.
The tool magazine 120 comprises a base member 122 in the formed of a circular plate. The base member 122 has a plurality of receptacles 124 of recesses which open outwardly in the radial directions, and are equally disposed at an angle in the peripheral direction. A tool is held in each of the receptacles 124 via a tool holder 126. The tool magazine 120 is supported, for rotating within a vertical plane, by a supporting structure such as a frame (not shown) via a rotating shaft 120a which is held horizontally. The rotating shaft 120a is coupled with an output shaft of a servomotor 18 (
The tool changer 140 is disposed between the tool magazine 120 and the machine tool 100, and provided with a changing arm 142 and a shifter 144. Provided at the either ends of the changing arm 142 are grippers 142a and 142b each of which is configured to hold a tool. The changing arm 142 is capable of liner movement, i.e., advancing and retracting along the rotational axis Os of the spindle 110, and rotational movement, i.e., rotating by 90° or 180° within a plane perpendicular to the rotational axis Os of the spindle 110.
The shifter 144 is configured to horizontally reciprocate between the tool magazine 120 and the changing arm 142. The shifter 144 receives a tool, which is located at a waiting position 121 of the tool magazine 120, from the tool magazine 120 and transfers the tool to a tool handover position 146. Further, the shifter 144 receives a tool at the handover position 146 from the changing arm 142 and inserts the tool into one of the receptacles 124 positioned at the waiting position 121.
The control device 10 performs a feedback control similar to typical servo-controlling devices. The reading and interpreting section 12 reads and interprets an NC program which is input through input means 11, for example a network means such as a LAN, a key board, or a touch panel, and outputs operation commands 12a to the interpolating section 14. The operation commands 12a include a movement command for moving the receptacle 124, into which a tool need for the next process is inserted, to the waiting position. The interpolating section 14 interpolates the received operation commands 12a based on a interpolative function, and outputs position commands (pulse position commands) 14a suitable for a predetermined rotational velocity to the servo-controlling section 16. The servo-controlling section 16 outputs, based on the received position commands 14, an electric current value as a torque command for rotating the tool magazine 120 to the servomotor 18. The rotational position and velocity 20a of the servomotor 18 are fed back to the servo-controlling section 16 from an encoder (rotary encoder) 20 of the servomotor 18.
During the above described replacement of the tools, an operator does not consider the positions of the tools in the peripheral direction of the tool magazine 120, whereby the tools are not distributed evenly in the peripheral direction of the tool magazine 120, and the tools are often mounted biasedly in the peripheral direction of the tool magazine 120 as shown in
With reference to
When the tool magazine 120, to which the tools are attached unevenly in the peripheral direction (
In order to solve such problems, according to the embodiment, the unbalance torque calculating section 22 receives torque command or electric current value 16b, output from the servo-controlling section 16, and position information 20b output from the encoder 20, and calculates the unbalance torque acting on the tool magazine 120. Then, the unbalance torque canceling section 24 receives the unbalance torque 22a, calculated by the unbalance toque calculating section 22, the torque command or the electric current value 16c from the servo-controlling section 16, and the position and velocity information 20c from the encoder 20, and corrects the torque 16b so as to cancel the unbalance torque. The acceleration/deceleration parameter modifying section 28 receives, from the unbalance section canceling section 24, the torque 24a corrected by the unbalance torque canceling section 24 and the position and velocity information 20c which the unbalance torque canceling section 24 has received from the encoder 20, and calculates the moment of inertia of the tool magazine 120 based on the corrected torque 24a. The acceleration/deceleration modifying section 28 receives the moment of inertia of the tool magazine 120 from the moment of inertia calculating section 26, and outputs acceleration/deceleration parameter to the servo-controlling section 16, after modifying (correcting) the acceleration/deceleration parameter, whereby the electric current value 16a, output from the servo-controlling section 16 to the servomotor 18, is optimized. Further, the control device 10 may be provided with an alarm presenting section 30 configured to present acoustic or visual alarm or caution when the unbalance torque calculated by the unbalance torque calculating section 22 exceeds a predetermined upper limit.
With reference to
As shown in
T1: Unbalance torque
L: Length from the center of tool magazine 120 to the center of gravity.
Referring to
T=T
0 cos θ (1)
Therefore, when stopped at a position rotated by θ=θ1 from the rotational angle of θ=0°, the stopping load torque T1 applied to the tool magazine 120 can be calculated by the following equation.
T
1
=T
0 cos θ1 (2)
When tool magazine 120 is stopped at a position further rotated 90° from the rotational position θ=Φ, the stopping load torque T2 applied to the tool magazine 120 can be calculated by the following equation.
T
2
=T
0 cos(θ1+90)=T0 sin θ1 (3)
Further, the formula of triangular function gives the following equation.
sin2θ1+cos2 θ1=1 (4)
Therefore, based on the equations (1)-(4), the unbalance torque T0 or the maximum stopping load torque can be calculated from the following equation.
T
0=(T12+T22)1/2 (5)
Furthermore, from equation (2), the initial phase θ1 is obtained from the following equation.
θ1=arccos(T1/T0) (6)
In this connection, it should be noted that although the stopping load torque is measure at two measuring points which are apart from each other by 90° in the peripheral direction about the center of the rotating shaft 120a in the present embodiment, the invention is not limited to this configuration. The measuring points may be apart from each other by an angle greater than 90°. Further, the measuring point is not limited to a single point, and the measurement may be carried out at a the stopping load torque may be measured at a plurality of points.
With reference to the flow chart show in
The unbalance torque may be measured and calculated when tools are replaced as described above. When the operator of the machine tool 100 starts to replace the tools (Step S10), the tool accommodating chamber 136 is put into a state allowing manual intervention by the operator (Step S12). This may be carried out by depressing a press button (not shown) provided on an operating panel (not shown) of the machine tool 100, whereby an automatic movement of the machine tool 100, which is not anticipated by the operator, is inhibited when the operator accesses the tool magazine 120.
Then, after the operator opens the ATC door 138a (Step S14), the operator accesses the tool magazine 120 in order to replace the tools (Step S16). Then, after the ATC door 138a is closed (Step S18), the intervention to the NC device is disengaged (Step S20) by depressing a press button provided on the operating panel (not shown) of the machine tool 100.
After the intervention to the NC device is disengaged, the NC device reads a program for measuring the unbalance torque of the tool magazine 120 to start the measurement of the unbalance torque. The unbalance torque calculating section 22 reads the electric current value 16b presently supplied to the servomotor 18, which keeps the tool magazine 120 stopped (Step S22). The torque (T1) (stopping load torque) necessary to keep the tool magazine stopped against the unbalance torque can be obtained based on the read electric current value 16b. Then, after the tool magazine 120 is rotated by 90° (Step S24), the electric current value 16b, necessary to keep the tool magazine 120 at the rotational position, is read from the servo-controlling section 16 (Step S26). The torque (T2) (stopping load torque) necessary to keep the tool magazine stopped against the unbalance torque can be obtained based on the read electric current value 16b.
Then, at Step S28, the unbalance torque calculating section 22 calculates the maximum unbalance toque T0, from equation (6), based on the two torque values (T1, T2) and equation (5), and the initial phase θ1.
Then, the torque canceling section 24 calculates, based on unbalance torque T0 calculated by the unbalance toque calculating section 22, the initial phase θ1 and the position information read from the encoder 20, the stopping load torque T from following equation (7), when the tool magazine 120 is at an angular position θ.
T=T
0 cos(θ1+θ) (7)
The unbalance torque canceling section 24 further receives the electric current value or the torque value 16c, supplied to the servomotor 18 of the tool magazine 120, from the servo-controlling section 16, and calculates torque τ by subtracting the unbalance torque T0 therefrom.
Furthermore, at Step S28, the moment of inertia calculating section 26 calculates total moment of inertia J of the tool magazine 120, including the base member 122 and the tools attached to the base member 122, based on the following method.
Following equation (8) presents the relation between the torque τ (load torque on motion) and the moment of inertia of the tool magazine 120, when the servomotor 18 rotates.
τ=Jα+DV+Fu (8)
The angular velocity V and the angular acceleration α can be calculated by the moment of inertia calculating section 26 based on the rotational velocity 20d of the servomotor 18. The unit vector u indicating the direction of velocity is positive when the tool magazine 120 rotates in one of the two rotational directions, and negative when rotating in the other direction. The variables to be obtained, when the tool magazine 120 rotates, are presented by the following equations.
(τn)=(τ0, τ1, τ2 . . . τk, τk+1 . . . τm) (n=0˜m) (9)
(Vn)=(V0, V1, V2 . . . Vk, Vk+1 . . . Vm) (n=0˜m) (10)
(αn)=(α0, α1, α2 . . . αk, αk+1 . . . αm) (n=0˜m) (11)
(un)=(u0, u1, u2 . . . uk, uk+1 . . . um) (n=0˜m) (12)
Accordingly, the values of the torque (load torque on motion) τ, the values of the angular velocity V, the values of the angular acceleration α, and the unit vectors u indicating the velocity directions can be read by the moment of inertia calculating section 26 at Steps S22 to S26. Then, the moment of inertia J, the viscous damping coefficient D and the coulomb friction torque F of the tool magazine 120 are calculated so that the difference between the sum of squares of the torque τn, presented by equation (9), and the sum of squares of the torque τ which is obtained by substituting the variables presented by equations (10), (11) and (12) into equation (8) is the minimum. Accordingly, these variables are calculated by a least squares method. Thus, the moment of inertia J of the tool magazine 120 is calculated by the moment of inertia calculating section 26. The moment of inertia J, calculated by the moment of inertia calculating section 26, includes the moment of inertia based on the masses of the base member 122 of the tool magazine 120 and the tools mounted to the tool magazine 120.
Then, at Step S30, it is determined as to whether or not the unbalance torque T0 exceeds a predetermined threshold value Ts. If the unbalance torque T0 exceeds the predetermined threshold value Ts (NO at Step S30), then the acceleration/deceleration parameter modifying section 28 maximizes the acceleration/deceleration parameter, outputs it to the servo-controlling section 16, and outputs a command to the alarm presenting section 30 to present acoustic or visual alarm or caution indicating that the unbalance torque T0 exceeds the predetermined threshold value. The acceleration/deceleration parameter includes the acceleration or gain.
If the unbalance torque does not exceeds the predetermined threshold value Ts (YES at Step S30), then the acceleration/deceleration parameter modifying section 28 outputs modified acceleration/deceleration parameter to the servo-controlling section 16. The modification of the acceleration/deceleration parameter is performed similar to the modification which is performed when the moment of inertia is increased, wherein the increase in the value of the unbalance torque T0 of the tool magazine 120 is interpreted into the increase in the moment of inertia of the tool magazine 120. In particular, moment of inertial correction values are associated with the respective values of the unbalance torque T0, and stored in the form of a table in a memory region of the control device 10, whereby the moment of inertial correction value is read from the table according to the value of the unbalance torque T0. The moment of inertial correction values to be added to the moment of inertia according to the increase in the unbalance torque T0 may be precedingly and experimentally obtained, and a table may be created and stored so as to associate the values of the unbalance torque T0 with the moment of inertia correction values. The acceleration/deceleration parameters are associated with respective values obtained by adding the moment of inertial correction values to the moments of inertia, and stored in the form of a table in a memory region of the control device 10, whereby the acceleration/deceleration parameter is read from the table according to the value obtained by adding the moment of inertial correction value to the moment of inertia. The acceleration/deceleration parameter is modified according to the values of the moment of inertia and the unbalance torque T0, whereby enabling more quick acceleration/deceleration, when the moment of inertia and the unbalance toque T0 are small, and whereby the tool magazine 120 can be positioned in a shorter time.
In the above described embodiment, while the motor controlling method according to the invention controls the drive motor for the tool magazine, the invention is not limited to this, and can be applied to a rotary feed shaft rotating about a horizontal or inclined rotational axis. For example, in a machine tool shown in
10 Control Device
18 Servomotor
20 Encoder
20
a Rotating Velocity
20
b Position Information
20
c Velocity Information and Position Information
20
d Rotating Velocity
22 Unbalance Torque Calculating Section
22
a Unbalance Torque
24 Unbalance Torque Canceling Section
100 Machine Tool
120 Tool Magazine
120
a Rotating Shaft
136 Tool Accommodating Chamber
This application is a U.S. National Stage Application of International Patent Application No. PCT/JP2015/055899, filed on Feb. 27, 2015, which is hereby incorporated by reference in the present disclosure in its entirety.
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/JP2015/055899 | 2/27/2015 | WO | 00 |