This invention relates to a numerical control method and its apparatus for controlling a machine having two moving shafts placed in parallel and separate servomotors for driving one of the shafts as a master shaft and the other as a slave shaft in the same direction and in particular to control for performing return to origin of the master shaft and the slave shaft according to a dog technique.
A numerical control apparatus performs return to origin to precisely grasp the origin on a machine coordinate system in the numerical control apparatus.
As a method of the return to origin, a technique for placing a limit switch for deceleration (dog) in the vicinity of the origin of a machine moving part is available. In the technique, when the machine moving part steps on the dog, a deceleration command is given to a servomotor and a shift is made by the origin shift amount of the difference between the origin and the grid position from the point in time at which the first grid position is reached leaving the dog, thereby stopping the movement of the shaft. The grid is based on a Z phase pulse output every revolution from an encoder placed in the servomotor.
At time t1 at which the machine moving part steps on the dog 131, a deceleration command is given to the servomotor for once stopping and then a move is started at sufficiently low speed (creep speed). When the dog 131 is left at time t2, a distance 136 of adding the distance from the position where the dog 131 is left to the first grid 133 and the origin shift amount 135 is calculated and the shaft move is stopped at the position. Accordingly, the shaft can be stopped precisely at the origin.
In
A return-to-origin command input through the machine operation panel 1 is sent to the move command vector distribution means 2, which then outputs move commands to the master shaft and the slave shaft. At this time, the move commands given to the master shaft and the slave shaft are set to have the same return-to-origin speed parameters are, for example. When a dog on signal is input from the dog 12, the return-to-origin processing means 3 of the master shaft cancels the move command of the master shaft and causes the master shaft to start to move at creep speed after stop with deceleration. When the dog is turned off (a limit switch leaves the dog), the return-to-origin processing means 3 acquires the distance to the current nearest grid from the encoder 15, moves the master shaft at creep speed at the distance of the distance from the dog off position to the nearest grid plus the origin shift amount of the master shaft stored in the parameter storage area 17 as the final move distance, and stops the master shaft when the master shaft has been moved at the move distance.
On the other hand, as for the slave shaft, when a dog on signal is input from the dog 13 to the return-to-origin processing means 7 of the slave shaft independently of the master shaft, the return-to-origin processing means 7 cancels the move command of the slave shaft and causes the slave shaft to start to move at creep speed after stop with deceleration. When the dog is turned off (limit switch leaves the dog), the return-to-origin processing means 7 acquires the distance to the nearest grid from the encoder 16, moves the slave shaft at creep speed at the distance of the distance from the dog off position to the nearest grid plus the origin shift amount of the slave shaft stored in the parameter storage area 17 as the final move distance, and stops the slave shaft when the slave shaft has been moved at the move distance.
By the way, in the numerical control apparatus for controlling the machine tool having the master shaft and the slave shaft, the origins of the shafts need to be made parallel. If return to origin is executed in a state in which the dogs 12 and 13 of the master shaft and the slave shaft are shifted in position, the move speed of the master shaft and that of the slave shaft are placed out of synchronization and thus the dogs 12 and 13 of the master shaft and the slave shaft need to be attached to parallel positions.
a and 8b are drawings to describe this point in detail.
In
In
To execute return to origin, as in
Thus, in the related art, the dogs of the shafts need to be attached to parallel positions as much as possible, namely, the dog position shift amount 64 shown in
A related art to the invention is disclosed in JP-A-8-22313. In the related art, the grid position shift amount between a master shaft and a slave shaft is calculated, the return-to-origin operation is performed based on a preset grid shift amount for the master shaft, and the return-to-origin operation of the master shaft and the slave shaft is performed based on the value resulting from adding grid shift amount and the position shift amount for the slave shaft, whereby the return-to-origin operation of the master shaft and the slave shaft is performed to precise positions.
However, in the return-to-origin method in the related art, if the number of dogs is one, a defective condition of the possibility of return to one-grid erroneous origin position may occur depending on the positional relationship between the master shaft and the slave shaft when the power is turned on.
In
If the positional relationship between the master shaft and the slave shaft after the dog is turned off is the positional relationship of 90 and 91 as in
However, if the positional relationship between the master shaft and the slave shaft after the dog is turned off is the positional relationship of 92 and 93 as in
Thus, the master shaft stops at the position shifted by the origin shift amount 110 from the grid 101 and the slave shaft stops at the position shifted by the grid position shift amount 112 between the master shaft and the slave shaft plus the origin shift amount 111 from the grid 104.
Therefore, one-grid shift occurs between the origin 120 of the master shaft and the origin 121 of the slave shaft and the shafts cannot return to the origins at parallel positions; there is the possibility of destroying the machine.
The invention is intended for solving the problems as described above and it is an object of the invention to provide a numerical control method and its apparatus for facilitating origin adjustment work of a master shaft and a slave shaft and enabling return to origin reliably at parallel positions.
To accomplish the object, according to the invention, there is provided a numerical control method of controlling a machine having two moving shafts placed in parallel and separate servomotors for driving one of the shafts as a master shaft and the other as a slave shaft in the same direction and performing return to origin of the above-mentioned master shaft and the slave shaft according to a dog technique, wherein in return to origin, the positional relationship is determined as to whether or not the above-mentioned slave shaft is ahead of the master shaft toward the origin direction, and the return to origin of the above-mentioned master shaft and the slave shaft is performed with one dog based on the determination result.
In the invention, virtual grids are set in the above-mentioned slave shaft at positions parallel with grids of the above-mentioned master shaft, if the determination result of the positional relationship indicates that the above-mentioned slave shaft is behind the above-mentioned master shaft toward the origin direction, return to origin of the above-mentioned master shaft is performed based on the value resulting from adding the grid interval and an origin shift amount and return to origin of the slave shaft is performed based on the value resulting from adding the distance from the position of the slave when the above-mentioned master shaft arrives at the first grid from stepping on the dog to the first virtual grid, the grid interval, and an origin shift amount, and if the determination result of the positional relationship indicates that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction, return to origin of the above-mentioned master shaft is performed based on the value resulting from adding the grid interval and the origin shift amount and return to origin of the above-mentioned slave shaft is performed based on the value resulting from adding the distance from the position of the slave when the master shaft arrives at the first grid from stepping on the dog to the first virtual grid and the origin shift amount.
In the invention, when the positional relationship is determined as to whether or not the above-mentioned slave shaft is ahead of the master shaft toward the origin direction, the determination is made based on the value of a counter of the slave shaft.
In the invention, if the value of the counter which is cleared each time a virtual grid of the slave shaft is passed through, and counts the grid interval of the slave shaft is grid interval/2<counter value≦grid interval when the master shaft is at the first grid position after the dog is turned off, it is determined that the above-mentioned slave shaft is behind the master shaft toward the origin direction, and if the value of the counter is 0≦counter value≦grid interval/2 when the master shaft is at the first grid position after the dog is turned off, it is determined that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction.
In the invention, if the value of the counter which is cleared each time an intermediate point between virtual grids of the slave shaft is passed through, and counts the grid interval of the slave shaft is 0≦counter value≦grid interval/2 when the master shaft is at the first grid position after the dog is turned off, it is determined that the above-mentioned slave shaft is behind the master shaft toward the origin direction, and if the value of the counter is grid interval/2<counter value≦grid interval when the master shaft is at the first grid position after the dog is turned off, it is determined that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction.
According to the invention, there is provided a numerical control apparatus for controlling a machine having two moving shafts placed in parallel and separate servomotors for driving one of the shafts as a master shaft and the other as a slave shaft in the same direction and performing return to origin of the above-mentioned master shaft and the slave shaft according to a dog technique, the numerical control apparatus comprising position determination means for determining the positional relationship as to whether or not the above-mentioned slave shaft is ahead of the master shaft toward the origin direction in return to origin, and return-to-origin management means for performing the return to origin of the above-mentioned master shaft and the slave shaft with one dog based on the determination result of the position determination means.
In the invention, virtual grids are set in the above-mentioned slave shaft at positions parallel with grids of the above-mentioned master shaft, if the determination result of the above-mentioned position determination means indicates that the above-mentioned slave shaft is behind the master shaft toward the origin direction, the above-mentioned return-to-origin management means performs return to origin of the above-mentioned master shaft based on the value resulting from adding the grid interval and an origin shift amount and performs return to origin of the above-mentioned slave shaft based on the value resulting from adding the distance from the position of the slave when the above-mentioned master shaft arrives at the first grid from stepping on the dog to the first virtual grid, the grid interval, and an origin shift amount, and if the determination result of the above-mentioned position determination means indicates that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction, the above-mentioned return-to-origin management means performs return to origin of the above-mentioned master shaft based on the value resulting from adding the grid interval and the origin shift amount and performs return to origin of the above-mentioned slave shaft based on the value resulting from adding the distance from the position of the slave when the master shaft arrives at the first grid from stepping on the dog to the first virtual grid and the origin shift amount.
In the invention, the above-mentioned position determination means comprises a counter for counting the grid interval of the slave shaft and when determining the positional relationship as to whether or not the above-mentioned slave shaft is ahead of the master shaft toward the origin direction, the above-mentioned position determination means uses the above-mentioned counter to determine the positional relationship.
In the invention, the counter of the above-mentioned position determination means is a counter cleared each time a virtual grid of the slave shaft is passed through, and if the value of the counter is grid interval/2<counter value≦grid interval when the master shaft is at the first grid position after the dog is turned off, the above-mentioned position determination means determines that the above-mentioned slave shaft is behind the master shaft toward the origin direction, and if the value of the counter is 0≦counter value≦grid interval/2, the above-mentioned position determination means determines that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction.
In the invention, the counter of the above-mentioned position determination means is a counter cleared each time an intermediate point between virtual grids of the slave shaft is passed through, and if the value of the counter is 0≦counter value≦grid interval/2 when the master shaft is at the first grid position after the dog is turned off, the above-mentioned position determination means determines that the above-mentioned slave shaft is behind the master shaft toward the origin direction, and if the value of the counter is grid interval/2<counter value≦grid interval, the above-mentioned position determination means determines that the above-mentioned slave shaft is ahead of the master shaft toward the origin direction.
a and 8b are drawings to show the return-to-origin operation of the numerical control apparatus in the related art for controlling a machine having a master shaft and a slave shaft.
First Embodiment.
A first embodiment of a numerical control apparatus according to the invention will be discussed with
In the usual return to origin, the position moved by the origin shift amount from the first grid after the dog is turned off is set as the origin, but the origin in the first embodiment of the invention is the position moved by the origin shift amount from the second grid after the dog is turned off.
In
Using the remaining distance thus calculated, the master shaft moves at the remaining distance of the master shaft, whereby the master shaft can arrive at the origin of the master shaft. The slave shaft moves at the remaining distance of the slave shaft, whereby the slave shaft can arrive at the origin of the slave shaft.
Next, a method for the position determination means 19 to determine the positional relationship between the master shaft and the slave shaft, namely, whether the master shaft and the slave shaft have the positional relationship in
The position determination means 19 can determine which shaft is ahead of the other assuming that the shift between the master shaft and the slave shaft is less than a half of a grid.
In
To use a counter set to 0 at each intermediate point between the virtual grids of the slave shaft, namely, a counter as indicated by the chain line in
As described above, according to the invention, in the numerical control apparatus for executing return to origin of the master shaft and the slave shaft according to the dog technique, it is made possible to execute return to origin using only one dog and thus origin adjustment work is facilitated. Moreover, in return to origin, the positional relationship is determined as to whether or not the slave shaft is ahead of the master shaft toward the origin direction, so that it is made possible to reliably execute return to origin at parallel positions.
The numerical control method and its apparatus according to the invention are suited for performing return to origin of the master shaft and the slave shaft according to the dog technique when performing return to origin of a machine having two moving shafts placed in parallel and separate servomotors for driving one of the shafts as the master shaft and the other as the slave shaft in the same direction.
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP02/00276 | 1/17/2002 | WO | 00 | 3/6/2003 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO03/06061 | 7/24/2003 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
4559798 | Hayashi et al. | Dec 1985 | A |
4604560 | Inagaki et al. | Aug 1986 | A |
4847777 | Konno | Jul 1989 | A |
4906908 | Papiernik et al. | Mar 1990 | A |
5070288 | Ikeda et al. | Dec 1991 | A |
5309074 | Mizukami | May 1994 | A |
5391970 | Chaffee et al. | Feb 1995 | A |
5949681 | Asai et al. | Sep 1999 | A |
6018685 | Fujita et al. | Jan 2000 | A |
6107769 | Saylor et al. | Aug 2000 | A |
6794842 | Sano | Sep 2004 | B2 |
20010002509 | Suhara | Jun 2001 | A1 |
Number | Date | Country |
---|---|---|
63-602 | Jan 1988 | JP |
4-130501 | May 1992 | JP |
8-22313 | Jan 1996 | JP |
2000-5822 | Jan 2000 | JP |
Number | Date | Country | |
---|---|---|---|
20040232870 A1 | Nov 2004 | US |