1. Field of the Invention
The present invention relates to a synchronization control apparatus that provides drive control with a plurality of axes synchronized.
2. Description of the Related Art
When the master axis 1 and the slave axis 2 perform a synchronous operation at a fixed speed ratio during a designated interval (see <1> in
A synchronization control apparatus disclosed in Japanese Patent Application Laid-Open No. 2006-164009 moves a master axis and a slave axis while gradually changing the speed ratio of the slave axis to the master axis. When this operation is performed during an interval preceding a synchronization start position of the slave axis 2, the speed of the slave axis 2 can be gradually changed (see <2> in
If an operation for simultaneously achieving the position and speed ratio between the master axis 1 and the slave axis 2 (hereinafter referred to as a synchronization preparation operation) is performed at the beginning of a synchronous operation without properly setting a slave axis movement amount for the synchronization preparation operation, proper acceleration is not achieved. Further, when the speed of the master axis 1 changes, the acceleration of the slave axis 2 also changes and cannot be maintained constant.
In view of the above-described problems in the prior art techniques, an object of the present invention is accordingly to provide a synchronization control apparatus that performs a synchronization preparation operation by calculating the start point of an acceleration interval during which a slave axis can gradually accelerate toward a synchronization start position, moving a master axis and the slave axis, and gradually accelerating the slave axis in accordance with the movement of the master axis.
The synchronization control apparatus according to the present invention initiates a synchronous operation immediately after a slave axis moves to a designated position while a master axis moves to a designated position. The synchronization control apparatus includes a designation unit, a movement amount calculation unit, and a movement unit. The designation unit designates a position of the master axis, a position of the slave axis, and a speed ratio that prevails when the master axis and the slave axis finish their designated movement. The movement amount calculation unit calculates a movement amount required for the slave axis to move in accordance with the position of the master axis in such a manner that the slave axis moves to the designated position when the master axis arrives at the designated position, and that the speed ratio of the slave axis to the master axis is as designated by the designation unit. The movement unit moves the slave axis to the position that is forward of the designated position by the movement amount calculated by the movement amount calculation unit, and then moves the slave axis to an end point in accordance with the position of the master axis.
The synchronization control apparatus according to the present invention initiates a synchronous operation immediately after a slave axis moves a designated distance while a master axis moves to a designated position. The synchronization control apparatus includes a designation unit, a movement amount calculation unit, and a movement unit. The designation unit designates a position of the master axis, a movement amount of the slave axis, and a speed ratio that prevails when the master axis and the slave axis finish their designated movement. The movement amount calculation unit calculates a movement amount required for the slave axis to move in accordance with the position of the master axis in such a manner that the slave axis moves the designated distance when the master axis arrives at the designated position, and that the speed ratio of the slave axis to the master axis is as designated by the designation unit. The movement unit moves the slave axis by an amount that is calculated by subtracting the movement amount calculated by the movement amount calculation unit from the designated movement amount, and then moves the slave axis to an end point in accordance with the position of the master axis.
The synchronization control apparatus according to the present invention initiates a synchronous operation immediately after a slave axis moves to a designated position while a master axis moves a designated distance. The synchronization control apparatus includes a designation unit, a movement amount calculation unit, and a movement unit. The designation unit designates a movement amount of the master axis, a position of the slave axis, and a speed ratio that prevails when the master axis and the slave axis finish their designated movement. The movement amount calculation unit calculates a movement amount required for the slave axis to move in accordance with the position of the master axis in such a manner that the slave axis moves to the designated position when the master axis finishes moving the designated distance, and that the speed ratio of the slave axis to the master axis is as designated by the designation unit. The movement unit moves the slave axis to the position that is forward of the designated position by the movement amount calculated by the movement amount calculation unit, and then moves the slave axis to an end point in accordance with the position of the master axis.
The synchronization control apparatus according to the present invention initiates a synchronous operation immediately after a slave axis moves a designated distance while a master axis moves a designated distance. The synchronization control apparatus includes a designation unit, a movement amount calculation unit, and a movement unit. The designation unit designates a movement amount of the master axis, a movement amount of the slave axis, and a speed ratio that prevails when the master axis and the slave axis finish their designated movement. The movement amount calculation unit calculates a movement amount required for the slave axis to move in accordance with the position of the master axis in such a manner that the slave axis moves by the designated movement amount when the master axis finishes moving the designated distance, and that the speed ratio of the slave axis to the master axis is as designated by the designation unit. The movement unit moves the slave axis by an amount that is calculated by subtracting the movement amount calculated by the movement amount calculation unit from the designated movement amount, and then moves the slave axis to an end point in accordance with the position of the master axis.
The synchronization control apparatus may include a unit that designates an acceleration of the slave axis. The movement amount calculation unit may calculate a movement amount in such a manner that the acceleration prevailing during movement agrees with the designated acceleration.
The movement unit may move the slave axis at a speed that is calculated by adding an axis speed of the slave axis for movement to an acceleration start position to an axis speed for accelerating the slave axis in accordance with the master axis.
When configured as described above, the present invention can automatically maintain a constant acceleration operation of the slave axis during the synchronization preparation operation without having to change a program even if a change is applied to the position of the slave axis and the speed of the master axis that prevail at the beginning of the synchronization preparation operation. Therefore, when, for instance, the acceleration is designated, it is possible to stabilize the influence on machining that is performed after the start of a synchronous operation.
The above and other objects and features of the present invention will be apparent from the following description of embodiments that is given with reference to the appended drawings, in which:
A first embodiment of the present invention is included in claim 1.
However, if the slave axis 2 is suddenly synchronized with the master axis 1 in a state where the slave axis 2 is stopped at a start point of a synchronization interval, the speed of the slave axis 2 drastically changes from zero to generate a mechanical shock.
As such being the case, the system shown in
If the slave axis 2 synchronizes with the master axis 1 during an interval between the 200 mm position and 800 mm position of the slave axis 2, the operation of the slave axis 2 in this machining cycle is specified as indicated by a program shown in
G100 is a command designating the synchronization preparation operation. X designates a slave axis position that prevails at the end of command execution. R designates a master axis position that prevails at the end of command execution. Q designates the speed ratio of the slave axis 2 to the master axis 1 that prevails at the end of command execution. G101 is a command designating the synchronous operation. The meanings of X and R for G101 are the same as for G100. G00 is an axis movement command that moves the slave axis 2 rapidly to an end point position and then stops it. When combined with the preceding command (“G100 with Q0.0”), this axis movement command performs the return operation.
The synchronization preparation operation according to the present embodiment is an operation performed to move the slave axis in such a manner that the slave axis just arrives at an end point position of the synchronization preparation operation when the master axis moves to an end point position of the synchronization preparation operation. The synchronization preparation operation according to the present embodiment is based on a command that provides acceleration/deceleration for attaining the designated speed ratio at the same time.
The synchronization control apparatus disclosed in Japanese Patent Application Laid-Open No. 2006-164009 performs a synchronization preparation operation by moving the slave axis in accordance with the movement of the master axis and changing the speed ratio in such a manner as to provide a designated movement amount of the slave axis. When the synchronous operation is performed subsequently to the synchronization preparation operation as described above, the speed changes of the master and slave axes become continuous between two different operations. This prevents the generation of a significant shock.
However, the synchronization control apparatus disclosed in Japanese Patent Application Laid-Open No. 2006-164009 generates a mechanical shock during an acceleration operation if the movement amount of the slave axis is improper during the synchronization preparation operation. This will now be explained with reference to
On the other hand, the present embodiment calculates a movement amount required for the acceleration of the slave axis from the speed of the master axis and the speed change pattern of the acceleration operation, and moves, immediately after the issuance of a command, the slave axis to a position required for performing the operation. During the synchronization preparation operation, the slave axis is moved in a sequence described below.
(1) The following values designated by the program (see
As an operating condition for the slave axis, acceleration/deceleration time is represented by T. The acceleration/deceleration time T is preset as a parameter in the synchronization control apparatus.
(2) A movement amount X1 during an acceleration interval of the slave axis and a master axis position Rs for the start of acceleration are calculated in accordance with the master axis speed Fm, the end point speed ratio Q, and the acceleration/deceleration time T.
First of all, let us suppose a slave axis speed f (Xm) during an acceleration operation that agrees with the acceleration/deceleration time T of the slave axis. The function f is determined by the position Xm of the master axis and satisfies the relationship given in Equation 1.
f(R)=Fm×Q (1)
In other words, when the master axis arrives at the end point (Xm=R), the slave axis speed is Q times Fm. Therefore, when the slave axis accelerates at a fixed acceleration, the slave axis speed changes as shown in
As the slave axis completely accelerates in time T, the amount of movement X1 during the acceleration interval is calculated from Equation 2.
X
1=(Fm×Q×T)/2 (2)
Let us assume that the amount of movement of the slave axis to the end point position X of the synchronization preparation operation is expressed by X1 and X2. The movement amount X2 is to be added to the movement amount X1 in order to supply the deficiency. The value X2 may differ from the value X1 in sign.
Further, when the slave axis moves by the movement amount X1 toward the end point position of the synchronization preparation operation, the position Rs of the master axis, which is a condition for the start of that movement, is calculated from Equation 3. The position Rs of the master axis is a master axis position at which the slave axis starts moving for the synchronization preparation operation in accordance with the master axis.
R
s
=R−(Fm×T) (3)
(3) For the movement amount X2, which is calculated as described in (2) above, the slave axis is moved and stopped before the master axis arrives at the position Rs.
First of all, when the synchronization preparation operation starts, the slave axis begins to move by the movement amount X2. This movement may be made without regard to the master axis. Therefore, for instance, the slave axis accelerates and decelerates to move rapidly in accordance, with a time constant T.
(4) Subsequently, a check is performed to determine whether the master axis has passed its position Rs at which the slave axis begins to accelerate. If the master axis has not passed its position Rs, the speed is set to be zero. If the master axis has passed its position Rs, the slave axis is moved in accordance with the position of the master axis. In this instance, a command designating a speed is issued by calculating f (Xm).
When the slave axis finishes moving by the movement amount X1 for the acceleration interval, the synchronization preparation operation terminates, and then the next operation, that is, the synchronous operation, starts.
When the movement amount of the slave axis is divided into two movement amounts, namely, X1 and X2, as described above, the movement amount X1 for the interval during which acceleration is performed in accordance with the movement of the master axis can be maintained within a proper range. Thus, even if the speed of the master axis is changed, the slave axis operation during the acceleration interval can be adapted to meet desired conditions by varying the movement amount X1 without changing the program.
In the present embodiment, the slave axis starts the synchronization preparation operation when it is stopped. However, if a movement command is issued immediately before the synchronization preparation operation, the slave axis may operate without changing its speed that prevails at an end point of a preceding operation. Further, the present embodiment has been described on the assumption that two axes connected to the synchronization control apparatus, namely, the master axis and the slave axis, are subjected to synchronization control. Alternatively, however, an additional axis may also be controlled as a slave axis. Furthermore, when the master axis is connected to an external control apparatus, the position and speed of the master axis may be fed back from its position/speed detector so that synchronization control is exercised to move the slave axis according to that position.
A second embodiment of the present invention is included in claim 2.
A machine capable of arbitrarily designating the position of the slave axis for machining may operate without using a command that designates an end point position. In such an instance, the movement of the machine can be written by designating a relative movement amount for the synchronization preparation operation of the slave axis 2. In this case, the end point position of an operation can be determined by adding a movement amount designated by the program to the position of the slave axis 2 that prevails at the beginning of the operation. Using the above-described determined end point positions makes it possible to perform the same synchronization preparation operation as the first embodiment.
A third embodiment of the present invention is included in claim 3.
An end point position of an operation can be determined by adding a movement amount designated by the program to the position of the master axis 1 at the beginning of the operation. Using the above-described determined end point positions makes it possible to perform the same synchronization preparation operation as the first embodiment.
A fourth embodiment of the present invention is included in claim 4.
In the fourth embodiment, the movement amount is designated for both the master axis and the slave axis. The synchronization control apparatus according to the fourth embodiment has both the features of the slave axis 2 according to the second embodiment and the features of the master axis 1 according to the third embodiment.
A fifth embodiment of the present invention is included in claim 5.
The following is a description of a case where As is designated as the acceleration of the slave axis instead of designating the acceleration/deceleration time T of the slave axis in the first embodiment. In order to let the slave axis attain a speed Fm*Q, which is obtained by multiplying the speed of the master axis by the speed ratio Q, it is necessary to accelerate the slave axis for a period of time expressed by Equation 4.
In the above instance, the acceleration remains unchanged. Therefore, the slave axis begins to accelerate at a position that is forward of an end point by the amount expressed by Equation 5.
In other words, the amount of slave axis movement during the acceleration interval is expressed by Equation 6.
The distance between a start point Rs and an end point R, which represents the amount of master axis movement during the acceleration interval, is expressed by Equation 7.
Thus, the master axis position Rs at which master axis acceleration begins can be calculated from Equation 8.
When the above method is used, the slave axis performs the synchronization preparation operation at the designated acceleration A. Therefore, the synchronous operation can be started without changing the acceleration even if the program is operated with the master axis speed changed.
In the first embodiment, immediately after the start, a speed V2 is calculated from the movement amount X2 in order to move the slave axis. Subsequently, the position of the master axis is monitored in the first embodiment. In the sixth embodiment, however, the position of the master axis is monitored to be able to start an acceleration operation by the movement amount X1 without waiting for the completion of movement by the movement amount X2. The speed for the movement amount X1 after the start is assumed to be V1. Then the value V1+V2 is designated to the speed of the slave axis to let operations overlap.
A CMOS 14 is backed up by a battery (not shown) and configured as a nonvolatile memory that retains its content even when the synchronization control apparatus 10 is turned off. The CMOS 14 stores, for example, an operating program read through an interface 15 and an operating program input through the display/MDI unit 34.
The interface 15 permits the synchronization control apparatus 10 to be connected to an external device such as an adapter. An operating program or the like is read from an external device. A programmable machine controller (PMC) 16 uses a sequence program incorporated in the synchronization control apparatus 10 in order to output a signal to an auxiliary device of the machine through an I/O unit 17 for control purposes.
The display/MDI unit 34 is a manual data input device having, for example, a display and a keyboard. An interface 18 receives commands and data from the keyboard of the display/MDI unit 34 and delivers them to the CPU 11.
An axis control units 20, 21 for each axis receives a commanded movement amount of each axis from the CPU 11 and outputs a command for each axis to a servo amplifier 22, 23. Upon receipt of the command, the servo amplifier 22, 23 drives a servo motor 30, 31 for the master axis or the slave axis. The servo motor 30, 31 for the master or slave axis incorporates a position/speed detector. A position/speed feedback signal from the position/speed detector is fed back to the axis control units 20, 21 to exercise position/speed feedback control. Position/speed feedback is omitted from
In the embodiment depicted in
[Step sa01] Command information is read from a block of the program. This step corresponds to (1) of the first embodiment.
[Step sa02] The master axis speed is acquired.
[Step sa03] The movement amount X1 of the slave axis during the acceleration interval is calculated. This step corresponds to (2) of the first embodiment.
[Step sa04] The position Rs of the master axis, which is a start condition for the acceleration interval, is calculated.
[Step sa05] The movement amount X2 of the slave axis during a non-acceleration interval is calculated.
[Step sa06] The speed V2 of the slave axis is calculated from time elapsed after the beginning of commanding and the movement amount X2 during the non-acceleration interval. The calculated speed V2 is then commanded. This step corresponds to (3) of the first embodiment.
[Step sa07] A check is performed to determine whether the master axis has passed a commanded end point. If the master axis has passed the commanded end point (YES), the process terminates. If the master axis has not passed the commanded end point (NO), processing proceeds to step sa08. Step sa07 corresponds to (4) of the first embodiment.
[Step sa08] The speed V1 of the slave axis is calculated from the master axis position and the movement amount X1 during the acceleration interval. The calculated speed V1 is then commanded. Upon completion of step sa08, processing returns to step sa07.
[Step sb01] Command information is read from a block of the program.
[Step sb02] The master axis speed is acquired.
[Step sb03] The movement amount X1 of the slave axis during the acceleration interval is calculated.
[Step sb04] The position R5 of the master axis, which is a start condition for the acceleration interval, is calculated.
[Step sb05] The movement amount X2 of the slave axis during the non-acceleration interval is calculated.
[Step sb06] A check is performed to determine whether the master axis has passed a commanded end point. If the master axis has passed the commanded end point (YES), the process terminates. If the master axis has not passed the commanded end point (NO), processing proceeds to step sb07.
[Step sb07] The speed V1 is calculated from the master axis position and the movement amount X1 during the acceleration interval.
[Step sb08] The speed V2 is calculated from time elapsed after the beginning of commanding and the movement amount X2 during the non-acceleration interval.
[Step sb09] A speed command for the slave axis is determined by adding V2 to V1. Upon completion of step sb09, processing returns to step sb06.
Number | Date | Country | Kind |
---|---|---|---|
2014-046866 | Mar 2014 | JP | national |