Operation control device and program
By using composite drive signals and adjusting gain values, the system synchronizes CNC and PMC drive signals effectively, improving processing speed and accuracy in production systems.
Patent Information
- Application Number
- JP2023525265
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-06-02
- Publication Date
- 2024-11-13
- Estimated Expiration
- 2041-06-02
AI Technical Summary
Existing production systems face challenges in synchronizing CNC and PMC drive signals, leading to synchronization errors and reduced machining speed when trying to match gains for accuracy.
The system switches drive speeds using composite drive signals, calculates positional deviations, and adjusts gain values to combine drive signals, allowing for synchronized operation without synchronization errors.
This approach improves processing speed while suppressing synchronization errors, enhancing machining accuracy and versatility.
Smart Images

Figure 0007583161000001 
Figure 0007583161000002 
Figure 0007583161000003
Abstract
Description
[Technical field]
[0001] The present disclosure relates to an operation control device and a program. [Background technology]
[0002] A production system for machining a workpiece has been known. The production system includes a conveyor device for transporting the workpiece, at least one industrial machine arranged along the conveyor device, and a motion control device for controlling the operation of the conveyor device and the industrial machine.
[0003] The industrial machine has a tool for machining a workpiece. The industrial machine uses the tool to machine the workpiece that is transported. In this way, the industrial machine can machine the workpiece into a desired shape.
[0004] The motion control device has, for example, a function to control a conveyor device and a function to control an industrial machine. The motion control device operates both functions in sequence to make the industrial machine process a workpiece. In other words, the motion control device operates the production system using two systems of drive signals.
[0005] When controlling a production system using two systems of drive signals, it is preferable that the motion control device synchronizes one drive signal with the other drive signal. For example, it is preferable that the motion control device handles one drive signal and the other drive signal as one drive signal. This can improve production efficiency. As such a device, a CNC system has been proposed that controls the movement of each axis by superimposing a CNC (numerical control device) side axis movement command and a PMC (programmable machine controller) side axis movement command (see, for example, Patent Document 1). Also, a device has been proposed that performs tapping by synchronizing a main axis with a servo axis (see, for example, Patent Document 2). [Prior art documents] [Patent documents]
[0006] [Patent Document 1] Japanese Patent Application Publication No. 7-230312 [Patent Document 2] Patent No. 2713566 Summary of the Invention [Problem to be solved by the invention]
[0007] In the CNC system described in Patent Document 1, a CNC side axis movement command and a PMC side axis movement command are superimposed, so that the CNC system described in Patent Document 1 can perform both CNC control and PMC control.
[0008] However, when two sequential drive signals are used, the drive using one drive signal is executed after the axial movement using the other drive signal is completed, so it is difficult to operate the two drive signals appropriately by simply superimposing the two drive signals.
[0009] Furthermore, as described in Patent Document 2, when two axes are synchronized, a synchronization error may occur due to a difference in gain between the two axes. In this case, the synchronization error can be reduced by matching the gain of the servo axis to the gain of the spindle. That is, the synchronization error can be reduced by setting the gain to match the smaller gain. On the other hand, if the gain is set to match the smaller gain, the machining accuracy can be guaranteed, but the machining speed decreases. Therefore, it would be preferable to improve the machining speed while suppressing the occurrence of the synchronization error. [Means for solving the problem]
[0010] (1) The present disclosure relates to a motion control device that switches the drive speed of a first drive shaft using a composite drive signal obtained by combining two drive signals, and drives a second drive shaft that performs a task different from that of the first drive shaft using one of the combined drive signals, the motion control device including: a position deviation calculation unit that calculates a position deviation of the first drive shaft before switching of the drive speed of the first drive shaft, and that calculates a position deviation of the second drive shaft; and a gain value calculation unit that calculates a gain value of the first drive shaft after switching of the operation speed, based on the drive speed of the first drive shaft before switching of the operation speed, the calculated position deviation of the first drive shaft, and the calculated position deviation of the second drive shaft.
[0011] (2) The present disclosure also relates to a program that causes a computer to function as an operation control device that switches the drive speed of a first drive shaft using a composite drive signal obtained by combining two drive signals, and drives a second drive shaft that performs a task different from that of the first drive shaft using one of the combined drive signals, the program causing the computer to function as a position deviation calculation unit that calculates a position deviation of the first drive shaft before switching of the drive speed of the first drive shaft, and calculates the position deviation of the second drive shaft, and a gain value calculation unit that calculates a gain value of the first drive shaft after switching of the operation speed, based on the drive speed of the first drive shaft before switching of the operation speed, the calculated position deviation of the first drive shaft, and the calculated position deviation of the second drive shaft. Effect of the Invention
[0012] According to the present disclosure, it is possible to provide an operation control device and a program capable of improving the machining speed while suppressing the occurrence of synchronization errors. [Brief description of the drawings]
[0013] [Figure 1] 1 is a schematic configuration diagram showing a production system including an operation control device according to a first embodiment of the present disclosure. [Diagram 2] 1 is a conceptual diagram showing an overview of operations in a production system including a motion control device according to a first embodiment. [Diagram 3] 1 is a conceptual diagram showing an overview of operations in a production system including a motion control device according to a first embodiment. [Figure 4] 1 is a block diagram showing a configuration of an operation control device according to a first embodiment; [Diagram 5] 4 is a flowchart showing the operation of the operation control device according to the first embodiment. [Figure 6] FIG. 13 is a block diagram showing a configuration of an operation control device according to a modified example. [Figure 7] FIG. 13 is a block diagram showing a configuration of an operation control device according to a modified example. [Figure 8] FIG. 13 is a schematic diagram showing a shared axis controlled by a motion control device according to a modified example. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0014] Hereinafter, an operation control device 1 and a program according to each embodiment of the present disclosure will be described with reference to FIGS. First, before describing the operation control device 1 and the program according to each embodiment, an overview of a production system 100 including the operation control device 1 will be described.
[0015] The production system 100 is, for example, a system that processes a workpiece W while transporting it. The production system 100 includes a conveyor device 10, an industrial machine 20, and a motion control device 1, as shown in FIG.
[0016] The conveyor device 10 is a device that conveys the workpieces W. The conveyor device 10 conveys the workpieces W, for example, by rotating a motor (not shown). The conveyor device 10 conveys the workpieces W in a predetermined direction.
[0017] The industrial machine 20 is, for example, a machine tool. As shown in Fig. 1, two industrial machines 20 are arranged along the conveying direction of the workpiece W. The industrial machine 20 processes the workpiece W into a preset shape using, for example, a tool 21 (see Fig. 2). The industrial machine 20 includes various machines such as, for example, a machine tool, an industrial robot, a service robot, a forging machine, and an injection molding machine.
[0018] The motion control device 1 is a device that controls the operations of the conveyor device 10 and the industrial machine 20. The motion control device 1 controls the operation of the production system 100 using, for example, at least two systems of drive signals. The motion control device 1 uses, for example, a PLC (Programmable Logic Controller) as a first system of drive signals for simple operations such as simple processing and transportation, and for managing the equipment on the production system 100. Specifically, the motion control device 1 uses a PLC for transportation of the workpiece W by the conveyor device 10. In addition, the motion control device 1 uses, for example, a NC (Numerical Control) drive signal as a second system of drive signals for processing complex shapes and complex operations. Specifically, the motion control device 1 uses an NC for axial movement of the tool 21 of the industrial machine 20.
[0019] Here, the motion control device 1 controls the operation of the production system 100 by, for example, synthesizing (superimposing) the drive signal of the first system and the drive signal of the second system. In particular, the motion control device 1 drives the first drive axis S1 (for example, the tool axis) using a synthetic drive signal obtained by synthesizing two drive signals, and transports the workpiece using one of the synthesized drive signals. For example, as shown in FIG. 2 and FIG. 3, the motion control device 1 causes the tool 21 (the first drive axis S1 (the tool axis in this embodiment)) to machine the workpiece W by the NC while transporting (axis control) the workpiece W placed on the transport table T (the second drive axis S2 (the transport axis for transporting the workpiece in this embodiment)) by the PLC. The second drive axis S2 is a drive axis for performing a different task from the first drive axis S1. That is, the motion control device 1 starts machining the workpiece W by moving the tool 21 to a processing position P1 that is moved toward the workpiece W by a distance d with respect to the reference position P0 of the tool 21 at time t0. Next, at times t1, t2, and t3, the motion control device 1 causes the tool 21 to machine the workpiece W in accordance with the transportation of the workpiece W, thereby executing both transportation and machining.
[0020] [First embodiment] Next, the operation control device 1 and the program according to the first embodiment of the present disclosure will be described with reference to FIGS. The motion control device 1 according to this embodiment uses at least two drive signals to control the operation of a production system 100 including an industrial machine 20. As shown in FIG. 4, the motion control device 1 includes a first-system program storage unit 101, a first drive signal generation unit 102, a first drive signal output unit 103, a second-system program storage unit 104, a second drive signal generation unit 105, a second drive signal output unit 106, a selection acquisition unit 107, a synthesis timing acquisition unit 108, a synthesis timing determination unit 109, a synthesis drive signal generation unit 110, a position deviation calculation unit 121, a gain value calculation unit 122, a parameter setting unit 123, a selection unit 124, and a motion control unit 111. In this embodiment, a case where a state where a workpiece (second drive axis S2) is stopped is switched to a state where a workpiece is being transported (a state where the second drive axis S2 is being driven) will be described as an example.
[0021] The first-system program storage unit 101 is, for example, a secondary storage medium such as a hard disk. The first-system program storage unit 101 stores a program for generating a drive signal of the first system. In this embodiment, the first-system program storage unit 101 stores, for example, a program for PLC control. Specifically, the first-system program storage unit 101 stores a program for moving the axis of the conveyor device 10 to transport the workpiece W. That is, the first-system program storage unit 101 stores a program for driving the second drive axis S2 to transport the workpiece W. In addition, the first-system program storage unit 101 stores a gain value when driving the second drive axis S2.
[0022] The first drive signal generating unit 102 is realized, for example, by the operation of a CPU. The first drive signal generating unit 102 generates a first drive signal which is a drive signal of a first system. In this embodiment, the first drive signal generating unit 102 generates a drive signal for driving the shaft of the conveyor device 10. That is, the first drive signal generating unit 102 generates a drive signal for driving the second drive shaft S2.
[0023] The first drive signal output unit 103 is realized, for example, by the operation of a CPU. The first drive signal output unit 103 outputs a first drive signal that is a drive signal of a first system. The first drive signal output unit 103 outputs the first drive signal, for example, at a predetermined control frequency. Specifically, the first drive signal output unit 103 outputs the first drive signal at a control frequency shorter than that of the second drive signal output unit 106 described later.
[0024] The second-system program storage unit 104 is, for example, a secondary storage medium such as a hard disk. The second-system program storage unit 104 stores a program for generating a drive signal of the second system. In this embodiment, the second-system program storage unit 104 stores, for example, a program for NC control. Specifically, the second-system program storage unit 104 stores a program for moving an axis of the tool 21 (first drive axis S1) of the industrial machine 20 to machine the workpiece W. That is, the second-system program storage unit 104 stores a program for driving the first drive axis S1 to machine the workpiece W. The second-system program storage unit 104 also stores a gain value when driving the first drive axis S1.
[0025] The second drive signal generating unit 105 is realized, for example, by the operation of a CPU. The second drive signal generating unit 105 generates a second drive signal which is a drive signal of a second system. In this embodiment, the second drive signal generating unit 105 generates a drive signal for driving the shaft of the tool 21 (first drive shaft S1) of the industrial machine 20. That is, the second drive signal generating unit 105 generates a drive signal for driving the first drive shaft S1.
[0026] The second drive signal output unit 106 is realized, for example, by the operation of a CPU. The second drive signal output unit 106 outputs a second drive signal that is a drive signal of a second system. The second drive signal output unit 106 outputs the second drive signal at a drive frequency longer than that of the first drive signal output unit 103, for example.
[0027] The selection acquisition unit 107 is realized, for example, by the operation of a CPU. The selection acquisition unit 107 acquires a selection of whether or not to generate a composite drive signal. For example, when the first drive signal and the second drive signal are to be composited, the selection acquisition unit 107 acquires a selection of "yes" for composite. On the other hand, when the first drive signal and the second drive signal are not to be composited, the selection acquisition unit 107 acquires a selection of "no" for composite.
[0028] The synthesis timing acquisition unit 108 is realized, for example, by the operation of a CPU. The synthesis timing acquisition unit 108 acquires the timing for synthesizing the first drive signal and the second drive signal from the outside. When synthesis "Yes" is selected, the synthesis timing acquisition unit 108 acquires the timing for synthesizing the first drive signal and the second drive signal. For example, the synthesis timing acquisition unit 108 acquires a program block to be synthesized or a transport position, etc. as the synthesis timing. Specifically, in FIG. 2, the synthesis timing acquisition unit 108 acquires, as the synthesis timing, a first drive signal for transporting the workpiece W mounting table to position P1 and a second drive signal for driving the tool 21 (first drive axis S1) to machine the workpiece W. The synthesis timing acquisition unit 108 acquires the synthesis timing using an input device (not shown) such as a keyboard.
[0029] The combination timing determination unit 109 is realized, for example, by the operation of a CPU. The combination timing determination unit 109 determines the combination timing of the first drive signal and the second drive signal. The combination timing determination unit 109 determines the timing acquired by the combination timing acquisition unit 108 as the combination timing.
[0030] The composite drive signal generating unit 110 is realized, for example, by the operation of a CPU. The composite drive signal generating unit 110 generates a composite drive signal when a selection to generate a composite drive signal is acquired. The composite drive signal generating unit 110 also generates a composite drive signal by combining the first drive signal and the second drive signal based on the determined combining timing. The composite drive signal generating unit 110 generates a composite drive signal by combining the first drive signal and the second drive signal, at least one of which has been subjected to a predetermined correction. The composite drive signal generating unit 110 generates a composite drive signal by combining, for example, the first drive signal and the second drive signal, at least one of which has been multiplied by a predetermined magnification. The composite drive signal generating unit 110 also generates a composite drive signal by combining, for example, the first drive signal and the second drive signal, at least one of which has been inverted in sign. The composite drive signal generating unit 110 also generates a composite drive signal, for example, for changing the relative position of an object controlled by the second drive signal with respect to the position of an object controlled by the first drive signal. Specifically, the composite drive signal generating unit 110 generates a composite drive signal that changes the relative position of the tool 21 (first drive axis S1) controlled by the second drive signal with respect to the position of the workpiece W transported by the first drive signal. More specifically, the composite drive signal generating unit 110 generates a composite drive signal that corrects the difference between the position of the workpiece W transported by the first drive signal and the reference position of the tool 21 (first drive axis S1) controlled by the second drive signal. For example, in FIG. 2, the composite drive signal generating unit 110 generates a composite drive signal that moves the tool 21 (first drive axis S1) from the reference position P0 to the processing position P1 in the opposite direction to the transport direction of the workpiece W. That is, the composite drive signal generating unit 110 generates a composite drive signal that drives the axis to move the tool 21 (first drive axis S1) by a distance d in the opposite direction to the transport direction of the workpiece W.
[0031] The position deviation calculation unit 121 is realized, for example, by the operation of a CPU. The position deviation calculation unit 121 calculates the position deviation of the first drive axis S1 before the drive speed of the first drive axis S1 is switched, and calculates the position deviation of the second drive axis S2. The position deviation calculation unit 121 calculates the position deviation before the drive speed is switched, for example, by calculating the following formula (1). That is, the position deviation output unit calculates the position deviation of the first drive axis S1 when the first drive axis S1 is driven by the other drive signal to be combined with the combined drive signal. Here, Emcn1 indicates the position deviation of the first drive axis S1. Fmcn indicates the command speed of the first drive axis S1 by the drive signal before the drive speed is switched. Gmcn indicates the parameter setting value of the gain of the machining axis before the drive speed is switched. Emcn1=Fmcn / Gmcn... (1)
[0032] Further, the position deviation calculation unit 121 calculates the position deviation of the second drive axis S2, for example, by calculating the following formula (2). That is, the position deviation output unit calculates the position deviation of the second drive axis S2 when the second drive axis S2 is driven by one of the drive signals to be combined into the combined drive signal. Here, Eplc indicates the position deviation of the second drive axis S2. Fplc indicates the command speed of the second drive axis S2 by the drive signal before the drive speed is switched. Gplc indicates the parameter setting value of the gain of the second drive axis S2 before the drive speed is switched. Eplc=Fplc / Gplc (2)
[0033] The gain value calculation unit 122 is realized, for example, by the operation of a CPU. The gain value calculation unit 122 calculates a gain value of the first drive axis S1 after the operation speed switching based on the drive speed of the first drive axis S1 before the operation speed switching, the calculated position deviation of the first drive axis S1, and the calculated position deviation of the second drive axis S2. The gain value calculation unit 122 calculates a gain value of the drive axis in the drive after the operation speed switching so as to reduce the difference between the calculated position deviation of the first drive axis S1 before the drive speed switching and the position deviation of the first drive axis S1 after the drive speed switching. The gain value calculation unit 122 calculates a setting value of the gain in the drive after the operation speed switching so as to bring the difference between the calculated position deviation of the first drive axis S1 before the drive speed switching and the position deviation of the first drive axis S1 after the drive speed switching into a predetermined range, for example. The gain value calculation unit 122 calculates a gain value of the first driving axis S1, for example, using the position deviation of the first driving axis S1 when the workpiece W is transported as shown in the following formula (3), so as to make the position deviation of the first driving axis S1 the same before and after the drive speed change as shown in the following formula (4) [(4-1) to (4-4)]. Here, Emcn2 indicates the position deviation of the first driving axis S1 when the workpiece is transported. Gmcn2 indicates the gain value of the first driving axis S1 after the drive speed is switched. Emcn2=(Fmcn+Fplc) / Gmcn2 · · · (3)
[0034] Here, Gmcn2 can be obtained by substituting the formulas (1) to (3) into the following formula (4-1) and transforming it into the formulas (4-2) to (4-4). (Formula 4) Emcn1=Emcn2-Eplc (4-1) Fmcn / Gmcn=(Fmcn+Fplc) / Gmcn2-Fplc / Gplc ··· (4-2) (Fmcn+Fplc) / Gmcn2=Fmcn / Gmcn+Fplc / Gplc (4-3) Gmcn2=(Fmcn+Fplc) / (Fmcn / Gmcn+Fplc / Gplc) ··· (4-4)
[0035] The parameter setting unit 123 is realized, for example, by the operation of a CPU. The parameter setting unit sets the calculated gain value as a parameter of the first driving axis S1. The parameter setting unit 123 sets the calculated gain value as a parameter of the first driving axis S1 for, for example, a motion control device described later.
[0036] The selection unit 124 is realized, for example, by the operation of a CPU. The selection unit 124 selects, for the parameter to be set, between the calculated gain value and the smaller of the gain value of the first drive axis S1 and the gain value of the second drive axis S2 before the drive speed is switched. The selection unit 124, for example, acquires a selection input from the outside and selects the gain value to be set. The selection unit 124 makes it possible to guarantee the machining accuracy while allowing a decrease in the machining speed by selecting the smaller of the gain value of the first drive axis S1 and the gain value of the second drive axis S2 before the drive speed is switched.
[0037] Here, the parameter setting unit sets the selected gain value as the parameter of the first driving axis S1. For example, the parameter setting unit 123 sets the calculated gain value as the parameter of the first driving axis S1 before switching the driving speed.
[0038] The operation control unit 111 is realized, for example, by the operation of a CPU. The operation control unit 111 controls the operation of the production system 100 based on the first drive signal, the second drive signal, and the composite drive signal. For example, in FIG. 2, the operation control unit 111 controls the operation of the conveyor device 10 based on the first drive signal. That is, the operation control unit 111 controls the transportation of the workpiece W based on the first drive signal. Also, the operation control unit 111 controls the machining operation of the tool 21 (first drive axis S1) based on the second drive signal. That is, the operation control unit 111 controls the axis movement for the machining operation of the tool 21 (first drive axis S1) based on the second drive signal. Also, the operation control unit 111 controls the movement operation of the tool 21 (first drive axis S1) based on the composite drive signal. That is, the operation control unit 111 controls the position movement of the tool 21 (first drive axis S1) according to the transportation of the workpiece W (driving of the second drive axis S2) based on the composite drive signal. The operation control unit 111 controls the operations of the workpiece W (second drive axis S2) and the tool 21 (first drive axis S1) by instructing the conveyor device 10 (second drive axis S2) and the motor (first drive axis S1) of the industrial machine 20 to operate. In this embodiment, the operation control unit 111 controls the operations of the first drive axis S1 and the second drive axis S2 using set parameters, the combined drive signal after switching, and one of the combined drive signals.
[0039] Next, the flow of operations of the numerical control device of this embodiment will be described with reference to the flowchart of FIG. First, the selection acquisition unit 107 acquires a selection of whether or not to combine the first and second drive signals. The combination timing acquisition unit 108 determines whether or not to combine (step S1). If combination is to be performed (step S1: YES), the combination timing acquisition unit 108 acquires the combination timing. Then, the process proceeds to step S2. On the other hand, if combination is not to be performed (step S1: NO), the combination timing acquisition unit 108 causes the first drive signal generation unit 102 and the second drive signal generation unit 105 to generate the first drive signal and the second drive signal, respectively. Then, the process proceeds to step S5.
[0040] In step S2, the combination timing acquisition unit 108 acquires the combination timing. The combination timing acquisition unit 108 sends the acquired combination timing to the combination timing decision unit 109.
[0041] Next, the combining timing determination unit 109 determines the combining timing for combining the first drive signal and the second drive signal based on the acquired combining timing. The first drive signal output unit 103 and the second drive signal output unit 106 generate the first drive signal and the second drive signal (step S3), respectively, and send the generated first drive signal and the second drive signal to the combined drive signal generation unit 110. In addition, the first drive signal output unit 103 and the second drive signal output unit 106 each send the generated first drive signal and the second drive signal to the operation control unit 111.
[0042] Next, the composite drive signal generation unit 110 generates a composite drive signal from the generated first drive signal and second drive signal based on the combination timing determined by the combination timing determination unit 109 (step S4).
[0043] Next, the position deviation calculation unit 121 calculates the position deviation of the first driving axis S1 and the second driving axis S2 (step S5) Next, the gain value calculation unit 122 calculates the gain value after the driving speed is switched (step S6).
[0044] Next, a gain value to be set as a parameter is selected (step S7). If the calculated gain value is to be set as a parameter (step S7: YES), the process proceeds to step S8. On the other hand, if the smaller gain value of the gain values set for the first driving axis S1 and the second driving axis S2 is to be used (step S7: NO), the process proceeds to step S10.
[0045] In step S8, the parameter setting unit 123 sets the calculated gain value as the parameter of the first driving axis S1. Next, the process proceeds to step S9.
[0046] In step S9, the operation control unit 111 controls the first drive axis S1 using the composite drive signal with the set parameters. The operation control unit 111 also drives the second drive axis S2 using one of the drive signals included in the composite drive signal. This completes the operation according to this flow.
[0047] In step S10, the parameter setting unit 123 sets the smaller gain value of the first drive axis S1 and the second drive axis S2 as the parameter of the first drive axis S1. Then, the process proceeds to step S9. When the composite drive signal is not generated, the operation control unit 111 controls the conveyor device 10 and the industrial machine 20 based on the first drive signal and the second drive signal.
[0048] Next, the program of the present disclosure will be described. Each component included in the operation control device 1 can be realized by hardware, software, or a combination of these. Here, being realized by software means being realized by a computer reading and executing a program.
[0049] The program can be stored and provided to the computer using various types of non-transitory computer readable media. The non-transitory computer readable media includes various types of tangible storage media. Examples of the non-transitory computer readable media include magnetic recording media (e.g., flexible disks, magnetic tapes, hard disk drives), magneto-optical recording media (e.g., magneto-optical disks), CD-ROM (Read Only Memory), CD-R, CD-R / W, and semiconductor memory (e.g., mask ROM, PROM (Programmable ROM), EPROM (Erasable PROM), flash ROM, RAM (random access memory)). The program may also be provided to the computer by various types of transitory computer readable media. Examples of the transitory computer readable media include electric signals, optical signals, and electromagnetic waves. The transitory computer readable media can provide the program to the computer via a wired communication path such as an electric wire and an optical fiber, or via a wireless communication path.
[0050] As described above, the operation control device 1 and the program according to the first embodiment provide the following advantages.
[0051] (1) The motion control device 1 is a motion control device that switches the drive speed of a first drive axis S1 using a composite drive signal obtained by combining two drive signals, and drives a second drive axis S2 that performs a task different from that of the first drive axis S1 using one of the combined drive signals. The motion control device 1 is equipped with a position deviation calculation unit 121 that calculates the position deviation of the first drive axis S1 before the drive speed of the first drive axis S1 is switched, and calculates the position deviation of the second drive axis S2, and a gain value calculation unit 122 that calculates a gain value of the first drive axis S1 after the operation speed is switched, based on the drive speed of the first drive axis S1 before the operation speed is switched, the calculated position deviation of the first drive axis S1, and the calculated position deviation of the second drive axis S2. As a result, the motion control device 1 can suppress the occurrence of synchronization errors even when the inertia of the first drive shaft S1 changes due to a change in the drive speed. Since the occurrence of synchronization errors can be suppressed, the machining accuracy can be improved.
[0052] (2) The gain value calculation unit 122 calculates a gain value for the first drive axis S1 in drive after the operation speed switching so as to reduce the difference between the calculated position deviation of the first drive axis S1 before the drive speed switching and the position deviation of the first drive axis S1 after the drive speed switching. The gain value calculation unit 122 also calculates a setting value for the gain in drive after the operation speed switching so as to bring the calculated difference between the position deviation of the first drive axis S1 before the drive speed switching and the position deviation of the first drive axis S1 after the drive speed switching into a predetermined range. This allows the motion control device 1 to improve machining accuracy while further suppressing the occurrence of synchronization errors.
[0053] (3) The motion control device 1 further includes a parameter setting unit 123 that sets the calculated gain value as a parameter for the first drive axis S1, and a motion control unit 111 that controls the motion of the first drive axis S1 and the second drive axis S2 using the set parameters, the combined drive signal after switching, and one of the combined drive signals. This allows the motion control device 1 to control the position deviation of the first drive axis S1 to be closer to that before the operation of the second drive axis S2, and suppresses the occurrence of synchronization errors.
[0054] (4) The motion control device 1 further includes a selection unit 124 that selects, for the parameters to be set, between the calculated gain value and the smaller of the gain value of the first drive axis S1 and the gain value of the second drive axis S2 before the drive speed is switched, and the parameter setting unit 123 sets the selected gain value as the parameter of the first drive axis S1. This makes it possible to switch the machining accuracy according to the situation, thereby providing a highly versatile motion control device.
[0055] [Second embodiment] Next, a description will be given of an operation control device 1 and a program according to a second embodiment of the present disclosure. In describing the second embodiment, the same components as those in the above-described embodiment will be denoted by the same reference numerals, and the description thereof will be omitted or simplified. The motion control device according to the second embodiment differs from the first embodiment in that the drive speed of the second drive axis S2 changes when the first drive axis S1 is driven by the composite drive signal. Therefore, in the motion control device according to the second embodiment, the operations of the position deviation calculation unit 121 and the gain value calculation unit 122 are different.
[0056] The position deviation calculation unit 121 calculates the position deviation of the first drive axis S1 before the drive speed of the second drive axis S2 is switched by one of the drive signals and the position deviation of the second drive axis S2 before and after the drive speed switching. The position deviation calculation unit 121 calculates the position deviation of the first drive axis S1 before the drive speed switching by the following formula (5). The position deviation calculation unit 121 also calculates the position deviation of the second drive axis S2 before and after the drive speed switching by the following formula (6) [(6-1) and (6-2)]. The position deviation calculation unit 121 also uses formula (7) which indicates the position deviation of the first drive axis S1 after the drive speed switching. Then, the position deviation calculation unit 121 calculates the position deviation of the first drive axis S1 after the drive speed switching so that the first drive axis S1 is the same before and after the drive speed switching of the second drive axis S2, as shown in formula (8) [(8-1) and (8-2)]. Here, Fmcn1 indicates the drive speed of the first drive axis S1 before the drive speed is switched. Emcn1 indicates the position deviation of the first drive axis S1 before the drive speed is switched. Gmcn1 indicates the gain before the drive speed is switched. Fmcn2 indicates the drive speed of the first drive axis S1 after the drive speed is switched. Emcn1 indicates the position deviation of the first drive axis S1 after the drive speed is switched. Gmcn1 indicates the gain after the drive speed is switched.
[0057] Fplc1 indicates the speed of the second drive axis S2 before the drive speed is switched. Eplc1 indicates the position deviation of the second drive axis S2 before the drive speed is switched. Gplc1 indicates the gain of the second drive axis S2 before and after the drive speed is switched. Fplc2 indicates the speed of the second drive axis S2 after the drive speed is switched. Eplc2 indicates the position deviation of the second drive axis S2 after the drive speed is switched. Emcn1=Fmcn1 / Gmcn1 · · · (5) (Formula 6) Eplc1=Fplc1 / Gplc1 (6-1) Eplc2=Fplc2 / Gplc1 ··· (6-2) Emcn2=(Fmcn1+Fplc2) / Gmcn1 ··· (7)
[0058] Here, the formulas (5), (6-1), (6-2), and (7) are substituted into the following formula (8-1) to calculate the position deviation Gmcn2 of the first driving axis S1 after the driving speed is switched. (Formula 8) Emcn2-Eplc2=Emcn1-Eplc1 (8-1) Gmcn2=(Fmcn1+Fplc2)*Gmcn1*Gplc1 / (Fmcn1*GplC1+(Fplc2-Fplc1)*Gmcn1) ··· (8-2)
[0059] As described above, the operation control device 1 and the program according to the second embodiment have the following advantages. (5) The position deviation calculation unit 121 calculates the position deviation of the first drive axis S1 before the drive speed of the second drive axis S2 is switched by one of the drive signals and the position deviation of the second drive axis S2 before and after the drive speed switching, and the gain value calculation unit 122 calculates the gain value of the first drive axis S1 after the speed change of the second drive axis S2 based on the drive speed of the first drive axis S1 before and after the drive speed switching, the calculated position deviation of the first drive axis S1, and the calculated position deviation of the second drive axis S2 before and after the drive speed switching. As a result, the motion control device 1 according to the second embodiment can suppress synchronization errors and improve machining accuracy even when the speed of the second drive axis S2 is switched.
[0060] Although the preferred embodiments of the operation control device 1 and the program of the present disclosure have been described above, the present disclosure is not limited to the above-described embodiments and can be modified as appropriate. For example, in the above embodiment, as shown in FIG. 6, the second drive signal output unit 106 may output the second drive signal to the first drive signal output unit 103. The composite drive signal generation unit 110 may generate the composite drive signal in the first drive signal output unit 103. The first drive signal output unit 103 may output the first drive signal, the second drive signal, and the composite drive signal using a control frequency shorter than that of the output of the second drive signal. Here, the position deviation calculation unit 121, the gain value calculation unit 122, the parameter setting unit 123, and the selection unit 124 are disposed between the composite drive signal generation unit 110 and the operation control unit 111, as in FIG. 4 and as in the first embodiment. This allows the first drive signal, the second drive signal, and the composite drive signal to be output to the operation control unit 111 at a shorter control frequency. Therefore, it is possible to increase the control timing and realize more delicate machining.
[0061] In the above embodiment, as shown in FIG. 7, a position acquisition unit 112 may be further provided to acquire position information of the tool 21 relative to the workpiece W. A correction amount determination unit 113 may be further provided to determine a correction amount for correcting the movement amount of the target object based on the acquired position. The operation control unit 111 may control the production system 100 based on the first drive signal including the determined correction amount, the second drive signal, and the composite drive signal. Here, the position deviation calculation unit 121, the gain value calculation unit 122, the parameter setting unit 123, and the selection unit 124 are disposed between the composite drive signal generation unit 110 and the operation control unit 111, as in FIG. 4 and as in the first embodiment.
[0062] The position acquisition unit 112 is realized, for example, by the operation of a CPU. The position acquisition unit 112 acquires, for example, the position of the tool 21 (first drive axis S1) in a workpiece coordinate system. In addition, the position acquisition unit 112 acquires the position of the tool 21 (first drive axis S1) relative to the workpiece W, for example, based on an output signal of a sensor that acquires the position of the tool 21 (first drive axis S1).
[0063] The correction amount determination unit 113 is realized, for example, by the operation of a CPU. The correction amount determination unit 113 determines a correction amount (feedback amount) of the composite drive signal according to the relative positions of the workpiece W and the tool 21. The correction amount determination unit 113 sends the determined correction amount to the first drive signal generation unit 102. As a result, the correction amount determination unit 113 causes the first drive signal generation unit 102 to generate a first drive signal including the determined correction amount. The operation control unit 111 controls the production system 100 based on the first drive signal including the determined correction amount, the second drive signal, and the composite drive signal. This makes it possible to realize control that flexibly responds to changes in the shape of the workpiece W. Therefore, the machining accuracy of the production system 100 can be improved.
[0064] In the above embodiment, the operation of the synthesis timing acquisition unit 108 is not limited to acquiring synthesis timing inputted to an input device (not shown) such as a keyboard. The synthesis timing acquisition unit 108 may acquire synthesis timing set from another program or the like.
[0065] In the above embodiment, the first drive signal and the second drive signal are described as a PLC that transports the workpiece W and an NC that drives the tool 21 (first drive axis S1), but are not limited thereto. The first drive signal may be, for example, an NC that transports the workpiece W, or a PLC that performs simple machining on the workpiece W.
[0066] In the above embodiment, the motion control device 1 is described as controlling the motion using two systems of drive signals, but the present invention is not limited to this. The motion control device 1 may control the motion using three or more systems of drive signals. For example, the motion control device 1 may control the motion using three or more systems of drive signals, with the motion of each tool 21 (first drive axis S1) of multiple industrial machines 20 being one system.
[0067] In addition, in the above embodiment, if the first drive signal and the second drive signal are not to be combined, the composite drive signal generation unit 110 may output only the first drive signal and the second drive signal to the operation control unit 111 without generating a composite drive signal.
[0068] In the above embodiment, the first system is described as a PLC and the second system is described as an NC, but the present invention is not limited thereto. As shown in FIG. 8, the production system 100 may include a configuration (shared axis 200) common to the first system and the second system. That is, the production system 100 may include a shared axis 200 that can be operated by any of the first drive signal, the second drive signal, or the composite drive signal. When the composite drive signal is not generated (when the selection of "no composite" is acquired), the selection acquisition unit 107 may acquire a selection of either the first drive signal or the second drive signal as a signal for operating the shared axis 200. The selection acquisition unit 107 may select either the first drive signal or the second drive signal to operate the shared axis 200 based on an input from the outside, a command value included in the first drive signal, or a command value included in the second drive signal. Then, each of the first drive signal output unit 103 and the second drive signal output unit 106 may output the first drive signal or the second drive signal independently to the shared axis 200.
[0069] In the above embodiment, the combination timing determination unit 109 combines the first drive signal and the second drive signal based on the acquired combination timing, but this is not limited to this. The operation control device 1 does not need to include the combination timing acquisition unit 108 and the combination timing determination unit 109. In this case, the first drive signal output unit 103 and the second drive signal output unit 106 may output the first drive signal and the second drive signal for which the combination timing has been taken into consideration in advance, respectively. The combined drive signal generation unit 110 may generate a combined signal by simply superimposing the output first drive signal and the second drive signal.
[0070] Furthermore, in the above embodiment, the gain value calculation unit 122 may calculate the gain value of the first driving axis S1 in a direction along the driving direction of the second driving axis S2. The gain value calculation unit 122 may calculate the gain value of the first driving axis S1 in a direction along the traveling direction of the workpiece W, for example. Thereby, the gain value calculation unit 122 calculates the gain value only in a direction affected by, for example, the combination of the first driving signal and the second driving signal. Therefore, the calculation time of the gain value can be shortened compared to the case where the gain values in all directions are calculated. [Explanation of symbols]
[0071] 1. Motion control device 20 Industrial Machinery 21 Tools 100 Production System 103 First drive signal output unit 106 Second drive signal output section 107 Selection Acquisition Section 109 Synthesis timing determination unit 110 Composite drive signal generator 111 Motion control section 112 Position acquisition part 113 Correction amount determination unit 121 Position deviation calculation unit 122 Gain value calculation section 123 Parameter setting section S1 First drive shaft S2 Second drive shaft Double work
Claims
1. 1. A motion control device that switches the drive speed of a first drive shaft by using a composite drive signal obtained by combining two drive signals, and drives a second drive shaft that performs a different task from that of the first drive shaft by using one of the combined drive signals, a position deviation calculation unit that calculates a position deviation of the first drive shaft before switching of the drive speed of the first drive shaft and calculates a position deviation of the second drive shaft; a gain value calculation unit that calculates a gain value of the first drive axis after switching of the operation speed based on the drive speed of the first drive axis before switching of the operation speed, the calculated position deviation of the first drive axis, and the calculated position deviation of the second drive axis; An operation control device comprising:
2. the position deviation calculation unit calculates a position deviation of the first drive shaft before a drive speed of the second drive shaft is switched by the one drive signal, and a position deviation of the second drive shaft before and after the drive speed switching; 2. The motion control device according to claim 1, wherein the gain value calculation unit calculates a gain value of the first drive axis after a speed change of the second drive axis based on the drive speed of the first drive axis before and after the drive speed switching, the calculated position deviation of the first drive axis, and the calculated position deviation of the second drive axis before and after the drive speed switching.
3. The motion control device according to claim 1 , wherein the gain value calculation unit calculates a gain value of the first drive shaft in a direction along a drive direction of the second drive shaft.
4. 4. The motion control device according to claim 1, wherein the gain value calculation unit calculates a gain value of the first drive axis in driving after the operation speed switching so as to reduce a difference between the calculated position deviation of the first drive axis before the drive speed switching and the position deviation of the first drive axis after the drive speed switching.
5. 5. The motion control device according to claim 4, wherein the gain value calculation unit calculates a setting value of a gain in driving after the motion speed switching so that a difference between the calculated position deviation of the first drive axis before the drive speed switching and the calculated position deviation of the first drive axis after the drive speed switching falls within a predetermined range.
6. a parameter setting unit that sets the calculated gain value as a parameter of the first driving shaft; an operation control unit that controls operations of the first drive shaft and the second drive shaft using the set parameters, the combined drive signal after switching, and one of the drive signals to be combined; The motion control device according to claim 1 , further comprising:
7. a selector configured to select, for a parameter to be set, between a calculated gain value and a smaller gain value of the gain value of the first drive shaft or the gain value of the second drive shaft before the drive speed is switched; The motion control device according to claim 6 , wherein the parameter setting unit sets the selected gain value as the parameter for the first driving axis.
8. A program that causes a computer to function as a motion control device that switches the drive speed of a first drive shaft by using a composite drive signal obtained by combining two drive signals, and drives a second drive shaft that performs a different task from that of the first drive shaft by using one of the combined drive signals, The computer, a position deviation calculation unit that calculates a position deviation of the first drive shaft before switching of the drive speed of the first drive shaft and calculates a position deviation of the second drive shaft; a gain value calculation unit that calculates a gain value of the first drive axis after switching of the operating speed based on the drive speed of the first drive axis before switching of the operating speed, the calculated position deviation of the first drive axis, and the calculated position deviation of the second drive axis; A program that functions as a
Citation Information
Patent Citations
Statistical model-based moving beam type gantry type machine tool dual-drive feed error compensation method and model
CN104865894A
Conveyance line control device
JP1995125828A
Cnc system
JP1995230312A
Threading / tapping controller
JP2005216135A
Servo controller
JP2007042068A
