Synchronization of control device
09622201 ยท 2017-04-11
Assignee
Inventors
Cpc classification
G05B2219/37436
PHYSICS
G05B17/00
PHYSICS
G05B19/416
PHYSICS
International classification
G05B17/00
PHYSICS
Abstract
A synchronization control device includes a command movement amount calculation unit, a predicted command movement amount calculation unit, and a movement amount comparison unit for comparing a command movement amount with a predicted command movement amount, and synchronization of a driven shaft is not started when the predicted command movement amount is less than the command movement amount, and synchronization is started when the predicted command movement amount is equal to or greater than the command movement amount.
Claims
1. A synchronization control device configured to previously register a displacement table, in which displacement of a driven shaft is associated with respective phases of a drive shaft, and determine a displacement of the driven shaft with respect to the phase of the drive shaft and position the driven shaft on the basis of the displacement table, the synchronization control device comprising: a command movement amount calculation unit for calculating a command movement amount, which is an amount of movement of the driven shaft to a synchronization position, relative to a current phase of the drive shaft, on the basis of the displacement table; a predicted command movement amount calculation unit for calculating a predicted command movement amount, which is an amount of movement of the driven shaft to a synchronization position, relative to the phase of the drive shaft after the current phase, on the basis of the displacement table; and a movement amount comparison unit for comparing the command movement amount with the predicted command movement amount, wherein synchronization of the driven shaft is not started when the comparison result from the movement amount comparison unit indicates that the predicted command movement amount is less than the command movement amount, and synchronization is started when the predicted command movement amount is equal to or greater than the command movement amount.
2. The synchronization control device according to claim 1, wherein a permitted movement amount is set; and synchronization is started when the command movement amount is equal to or less than the permitted movement amount, and the predicted command movement amount is equal to or greater than the command movement amount.
3. The synchronization control device according to claim 2, wherein the predicted command movement amount calculated by the predicted command movement amount calculation unit is configured to be selected from any of a predicted command movement amount in a next computation period, a predicted command movement amount in each of a plurality of subsequent computation periods from the next period on, and a predicted command movement amount in each of a plurality of subsequent computation periods during the time of one revolution of the drive shaft, from the next period; and the movement amount comparison unit is configured to compare the selected predicted command movement amount and the command movement amount and starts synchronization when the command movement amount is smallest.
4. The synchronization control device according to claim 2, wherein a synchronization operation is started when a direction of movement based on the command movement amount calculated by the command movement amount calculation unit and a direction of movement based on the predicted command movement amount calculated by the predicted command movement amount calculation unit are the same, and the predicted command movement amount is equal to or greater than the command movement amount.
5. The synchronization control device according to claim 1, wherein the predicted command movement amount calculated by the predicted command movement amount calculation unit is configured to be selected from any of a predicted command movement amount in a next computation period, a predicted command movement amount in each of a plurality of subsequent computation periods from the next period on, and a predicted command movement amount in each of a plurality of subsequent computation periods during the time of one revolution of the drive shaft, from the next period; and the movement amount comparison unit is configured to compare the selected predicted command movement amount and the command movement amount and starts synchronization when the command movement amount is smallest.
6. The synchronization control device according to claim 5, wherein a synchronization operation is started when a direction of movement based on the command movement amount calculated by the command movement amount calculation unit and a direction of movement based on the predicted command movement amount calculated by the predicted command movement amount calculation unit are the same, and the predicted command movement amount is equal to or greater than the command movement amount.
7. The synchronization control device according to claim 1, wherein a synchronization operation is started when a direction of movement based on the command movement amount calculated by the command movement amount calculation unit and a direction of movement based on the predicted command movement amount calculated by the predicted command movement amount calculation unit are the same, and the predicted command movement amount is equal to or greater than the command movement amount.
8. A synchronization control device configured to previously register a displacement table, in which displacement of a driven shaft is associated with respective phases of a drive shaft, and determine a displacement of the driven shaft with respect to the phase of the drive shaft and position the driven shaft on the basis of the displacement table, the synchronization control device comprising: a command speed calculation unit for calculating a command speed, which is a speed of movement of the driven shaft to a synchronization position, relative to the current phase of the drive shaft, on the basis of the displacement table; a predicted command speed calculation unit for calculating a predicted command speed, which is a speed of movement of the driven shaft to a synchronization position, relative to the phase of the drive shaft after the current phase, on the basis of the displacement table; and a speed comparison unit for comparing the command speed with the predicted command speed, wherein synchronization of the driven shaft is not started when the comparison result from the speed comparison unit indicates that the predicted command speed is less than the command speed, and synchronization is started when the predicted command speed is equal to or greater than the command speed.
9. The synchronization control device according to claim 8, wherein a permitted movement speed is set; and synchronization is started when the command speed is equal to or lower than the permitted movement speed, and the predicted command speed is equal to or greater than the command speed.
10. The synchronization control device according to claim 9, wherein the predicted command speed calculated by the predicted command speed calculation unit is configured to be selected from any of a predicted command speed in a next computation period, a predicted command speed in each of a plurality of subsequent computation periods from the next period on, and a predicted command speed in each of a plurality of subsequent computation periods during the time of one revolution of the drive shaft, from the next period; and the speed comparison unit compares the selected predicted command speed and the command speed and starts synchronization when the command speed is smallest.
11. The synchronization control device according to claim 9, wherein a synchronization operation is started when a direction of movement based on the command speed calculated by the command speed calculation unit and a direction of movement based on the predicted command speed calculated by the predicted command speed calculation unit are the same, and the predicted command speed is equal to or greater than the command speed.
12. The synchronization control device according to claim 8, wherein the predicted command speed calculated by the predicted command speed calculation unit is configured to be selected from any of a predicted command speed in a next computation period, a predicted command speed in each of a plurality of subsequent computation periods from the next period on, and a predicted command speed in each of a plurality of subsequent computation periods during the time of one revolution of the drive shaft, from the next period; and the speed comparison unit compares the selected predicted command speed and the command speed and starts synchronization when the command speed is smallest.
13. The synchronization control device according to claim 12, wherein a synchronization operation is started when a direction of movement based on the command speed calculated by the command speed calculation unit and a direction of movement based on the predicted command speed calculated by the predicted command speed calculation unit are the same, and the predicted command speed is equal to or greater than the command speed.
14. The synchronization control device according to claim 8, wherein a synchronization operation is started when a direction of movement based on the command speed calculated by the command speed calculation unit and a direction of movement based on the predicted command speed calculated by the predicted command speed calculation unit are the same, and the predicted command speed is equal to or greater than the command speed.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) The abovementioned and further objects and characteristic features of the present invention will become evident from the following description of the embodiments with reference to the drawings, in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
(12)
(13) The CMOS 16 is backed up by a battery (not illustrated), and is composed as a non-volatile memory in which the storage state is maintained, even if the power supply to the numerical control device 100 is turned off. A processing program (NC program) which is read out via the interface 18 and a processing program input via the display device/MDI unit 60, and the like, are stored in the CMOS 16. Furthermore, various system programs for implementing editing mode processing, which is necessary for creating and editing processing programs, and processing for automatic operation, are written previously to the ROM 12.
(14) The displacement table which is used to implement the present invention can be input via the interface 18 or CRT/MDI unit 60, and stored in the CMOS 16. The concrete contents of the displacement table are described below.
(15) The programmable machine controller (PMC) 20 implements control by outputting signals via the I/O unit 22 to auxiliary equipment of a machine tool (for example, actuators such as robot hands for changing tools), in accordance with a sequence program which is installed in the numerical control device 100. Furthermore, the PMC 20 also receives signals from various switches, and the like, of an operating panel which is provided on the main body of the machine tool, applies necessary signal processing to the signals, and then transfers the signals to the CPU 10.
(16) The display device/MDI unit 60 is a manual data input device provided with a display monitor and a keyboard, etc., and the interface 24 receives commands and data from the keyboard of the display device/MDI unit and transfers same to the CPU.
(17) The shaft control circuits (26, 28) for each shaft receive the movement command amounts for each shaft from the CPU 10, and output the commands for each shaft to servo amplifiers. Upon receiving these commands, the servo amplifiers (42, 44) drive a drive shaft motor 52 and a driven shaft motor 54. The drive shaft motor 52 and driven shaft motor 54 are each provided internally with position and speed detectors (not illustrated), and position and speed feedback signals from these position and speed detectors are fed back to the shaft control circuits (26, 28) in order to perform feedback control of the position and speed. The position/speed feedback is not depicted in the block diagram.
First Embodiment
(18) Below, an embodiment of the present invention is described on the basis of the drawings, in relation to the displacement table illustrated in
(19)
(20) The values of the displacement of the driven shaft in each of the phases are compared. When the current phase of the drive shaft is n (partition 1 (D1)), then the amount of movement for synchronizing the driven shaft, which is waiting at the standby position P.sub.W, with the drive shaft, is (BA). Next, a predicted movement amount is predicted in the phases of the drive shaft from the current phase of the drive shaft on. In the present embodiment, when the current phase of the drive shaft is n (partition 1 (D1)), then the amount of movement for synchronizing the driven shaft with the drive shaft, in the phase n+1 of the drive shaft in the next partition 2 (D2), is predicted. The amount of movement in partition 2 (D2) according to the present embodiment is (CA). Here, when the amounts of movement BA and CA are compared, the amount of movement CA is shorter, and therefore, synchronization of the driven shaft is deferred in partition 1 (D1), and the driven shaft keeps a standby state.
(21) Next, the situation when the phase of the drive shaft becomes n+1 (partition 2 (D2)) is considered. In this case, the amount of movement for synchronizing the driven shaft which is waiting at the standby position P.sub.W, with the drive shaft, is (CA). The amount of movement for synchronizing the driven shaft with the drive shaft in the next phase n+2 of the drive shaft in partition 3 (D3) is predicted. The amount of movement in partition 3 (D3) according to the present embodiment is (DA). Here, when the amounts of movement CA and DA are compared, the amount of movement DA is shorter, and therefore, synchronization of the driven shaft is deferred in partition 2 (D2), and the driven shaft keeps a standby state.
(22) Next, the situation when the phase of the drive shaft becomes n+2 (partition 3 (D3)) is considered. In this case, the amount of movement for synchronizing the driven shaft which is waiting at the standby position P.sub.W, with the drive shaft, is (DA). Thereupon, the amount of movement for synchronizing the driven shaft with the drive shaft in the phase n+3 of the drive shaft in the next partition 4 (D4) is predicted. The amount of movement in partition 4 (D4) according to the present embodiment is (EA). Here, when the amounts of movement DA and EA are compared, the amount of movement EA is longer, and therefore, positioning of the driven shaft and synchronization with the drive shaft is performed in partition 3 (D3).
(23) In partition 4 (D4), since the driven shaft has been synchronized with the drive shaft in partition 3 (D3), then the synchronization is continued and the driven shaft is positioned towards displacement E.
(24) In other words, the amount of movement of the cam in each partition is (BA)>(CA)>(DA)(EA), and therefore synchronization is started in partition 3.
(25) In this way, the synchronization position of the driven shaft is determined, and an actual synchronization operation is carried out, on the basis of the displacement table.
(26)
(27) If the synchronization movement amount D.sub.S1 is equal to or less than the permitted movement amount D.sub.A (YES), then the procedure advances to step SA6, whereas if the synchronization movement amount D.sub.S1 is greater than the permitted movement amount D.sub.A (NO), then the procedure advances to step SA11. (Step SA6) The phase (n+1) of the drive shaft in the next partition period is predicted. (Step SA7) The displacement (C) of the driven shaft relative to the phase (n+1) of the drive shaft is acquired on the basis of the displacement table. (Step SA8) The synchronization movement amount D.sub.S2 (CA) from the standby position A of the driven shaft is acquired. (Step SA9) It is determined whether or not the synchronization movement amount D.sub.S1 is equal to or less than the synchronization movement amount D.sub.S2.
(28) If the synchronization movement amount D.sub.S1 is equal to or less than the synchronization movement amount D.sub.S2 (YES), then the procedure advances to step SA10, whereas if the synchronization movement amount D.sub.S1 is greater than the synchronization movement amount D.sub.S2 (NO), then the procedure advances to step SA11. (Step SA10) Synchronization is started taking the amount of movement of the driven shaft to be (BA). (Step SA11) The standby state is kept.
(29) In the present embodiment, before comparing the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft with the synchronization movement amount D.sub.S2 in the next partition period, the synchronization movement amount D.sub.S1 is compared with the permitted movement amount D.sub.A, but in cases where the driven shaft does not perform considerable displacement, for instance, the comparison of the synchronization movement amount D.sub.S1 and the permitted movement amount D.sub.A is omitted, and the synchronization start position of the driven shaft can be determined simply by comparing the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft with the synchronization movement amount D.sub.S2 in the next partition period.
(30) Furthermore, in the present embodiment, the synchronization start position of the driven shaft is determined by a comparison of the amount of movement for synchronization which simply involves comparing the synchronization movement amount D.sub.S2 in the next partition period with the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft, but it is also possible to select, as the object for comparison, the predicted command movement amount in the next computation period, the predicted command movement amount in each of a plurality of subsequent computation periods from the next period on, or the predicted command movement amount in each of a plurality of subsequent computation periods during one revolution of the drive shaft, from the next period, and to start synchronization when it is determined that the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft is smallest among these.
(31) An example of this is now described on the basis of
Second Embodiment
(32) In the first embodiment, the synchronization start position is determined by comparing the amounts of movement for synchronizing the driven shaft with the drive shaft, but it is also possible to start synchronization when the speed for synchronization at the current point is smallest, by comparing the speed for synchronization at the current point and the speed for synchronization at a point after the current point.
(33)
(34) If the synchronization speed S.sub.S1 is equal to or lower than the permitted movement speed S.sub.A (YES), then the procedure advances to step SB6, whereas if the synchronization speed S.sub.S1 is greater than the permitted movement speed S.sub.A (NO), then the procedure advances to step SB11. (Step SB6) The phase (n+1) of the drive shaft in the next partition period is predicted. (Step SB7) The displacement (C) of the driven shaft relative to the phase (n+1) of the drive shaft is acquired on the basis of the displacement table. (Step SB8) The synchronization speed S.sub.S2 from the standby position A of the driven shaft is acquired. (Step SB9) It is determined whether or not the synchronization speed S.sub.S1 is equal to or lower than the synchronization speed S.sub.S2.
(35) If the synchronization speed S.sub.S1 is equal to or lower than the synchronization speed S.sub.S2 (YES), then the procedure advances to step SB10, whereas if the synchronization speed S.sub.S1 is greater than the synchronization speed S.sub.S2 (NO), then the procedure advances to step SB11. (Step SB10) Synchronization is started, taking the synchronization speed of the driven shaft to be S.sub.S1. (Step SB11) The standby state is kept.
Third Embodiment
(36) In the first embodiment, the synchronization start position is determined by comparing the amounts of movement for synchronizing the driven shaft with the drive shaft, but in the present embodiment, the synchronization start position is determined by also taking account of the direction of movement, in addition to comparing the amounts of movement. This is described below on the basis of
(37)
(38) The values of the displacement of the driven shaft in each of the phases are compared. When the current phase of the drive shaft is n (partition 1 (D1)), then the amount of movement for synchronizing the driven shaft, which is waiting at the standby position P.sub.W, with the drive shaft, is (BA). Next, a predicted amount of movement is predicted in the phases of the drive shaft from the current phase of the drive shaft on. In the present embodiment, when the current phase of the drive shaft is n (partition 1 (D1)), then the amount of movement for synchronizing the driven shaft with the drive shaft, in the next phase n+1 of the drive shaft in the next partition 2 (D2), is predicted. The amount of movement in partition 2 (D2) according to the present embodiment is (CA). Here, when the amounts of movement BA and CA are compared, the amount of movement BA is shorter. However, in phase n+1 of the drive shaft in the next partition 2 (D2), the direction of movement of the shaft for synchronizing the driven shaft is the reverse of partition 1 (D1), and therefore synchronization of the driven shaft is deferred in partition 1 (D1), and the driven shaft keeps a standby state.
(39) Next, the situation when the phase of the drive shaft becomes n+1 (partition 2 (D2)) is considered. In this case, the amount of movement for synchronizing the driven shaft which is waiting at the standby position P.sub.W, with the drive shaft, is (CA). The amount of movement for synchronizing the driven shaft with the drive shaft in the next phase n+2 of the drive shaft in partition 3 (D3) is predicted. The amount of movement in partition 3 (D3) according to the present embodiment is (DA). Here, when the amounts of movement CA and DA are compared, the amount of movement CA is shorter. Furthermore, in partition 2 (D2) and partition 3 (D3), the direction of movement of the shaft in order to synchronize the driven shaft is the same, and therefore positioning of the driven shaft and synchronization thereof with the drive shaft is performed in partition 2 (D2).
(40) In other words, the amount of movement of the cam in each partition is:
|BA||CA||DA|
(BA)(CA)0
(CA)(DA)0
and therefore synchronization is started in partition 2.
(41) In partition 3 (D3) and partition 4 (D4), since the driven shaft has been synchronized with the drive shaft in partition 2 (D2), then the synchronization is continued and the driven shaft is positioned towards displacement D and displacement E.
(42) In this way, the synchronization position of the driven shaft is determined, and an actual synchronization operation is carried out, on the basis of the displacement table.
(43)
(44) In the present embodiment, before comparing the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft with the synchronization movement amount D.sub.S2 in the next partition period, the synchronization movement amount D.sub.S1 is compared with the permitted movement amount D.sub.A, but in cases where the driven shaft does not perform considerable displacement, for instance, the comparison of the synchronization movement amount D.sub.S1 and the permitted movement amount D.sub.A is omitted, and the synchronization start position of the driven shaft can be determined simply by comparing the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft with the synchronization movement amount D.sub.S2 in the next partition period.
(45) Furthermore, in the present embodiment, the synchronization start position of the driven shaft is determined by a comparison of the amount of movement for synchronization which simply involves comparing the synchronization movement amount D.sub.S2 in the next partition period with the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft, but it is also possible to select, as the object for comparison, the predicted command movement amount in the next computation period, the predicted command movement amount in each of a plurality of subsequent computation periods from the next period on, or the predicted command movement amount in each of a plurality of subsequent computation periods during one revolution of the drive shaft, from the next period, and to start synchronization when it is determined that the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft is smallest among the amounts of movement where the direction of movement according to the synchronization movement amount D.sub.S1 of the driven shaft at the current position of the drive shaft is the same as the direction of movement based on the predicted command movement amount in each of the plurality of computation periods.
Fourth Embodiment
(46) In the third embodiment, the synchronization start position is determined by comparing the amount of movement for synchronizing the driven shaft with the drive shaft, but it is also possible to start synchronization when the speed for synchronization at the current point is smallest, by comparing the speed for synchronization at the current point and the speed for synchronization at a point after the current point.
(47)
(48) If the absolute value of the synchronization speed S.sub.S1 is equal to or lower than the permitted movement speed S.sub.A (YES), then the procedure advances to step SD6, whereas if the absolute value of the synchronization speed S.sub.S1 is greater than the permitted movement speed S.sub.A (NO), then the procedure advances to step SD12. (Step SD6) The phase (n+1) of the drive shaft in the next partition period is predicted. (Step SD7) The displacement (C) of the driven shaft relative to the phase (n+1) of the drive shaft is acquired on the basis of the displacement table. (Step SD8) The synchronization speed S.sub.S2 from the standby position A of the driven shaft is acquired. (Step SD9) It is determined whether or not the direction of movement according to the synchronization speed S.sub.S1 and the direction of movement according to the synchronization speed S.sub.S2 are the same. If the directions are the same (YES), then the procedure advances to step SD10, and if the directions are not the same (NO), then the procedure advances to step SD12. (Step SD10) It is determined whether or not the absolute value of the synchronization speed S.sub.S1 is equal to or lower than the absolute value of the synchronization speed S.sub.S2. If the absolute value of the synchronization speed S.sub.S1 is equal to or lower than the absolute value of the synchronization speed S.sub.S2 (YES), then the procedure advances to step SD11, whereas if the absolute value of the synchronization speed S.sub.S1 is greater than the absolute value of the synchronization speed S.sub.S2 (NO), then the procedure advances to step SD12. (Step SD11) Synchronization is started taking the synchronization speed of the driven shaft to be S.sub.S1. (Step SD12) The standby state is kept.