Patent Application
20200333762
The present application claims priority under 35 U.S.C. § 119 to Japanese Patent Application No. 2019-081162, filed Apr. 22, 2019. The contents of this application are incorporated herein by reference in their entirety.
The present invention relates to a machine control system, a machine controller, and a vibration suppression command generation method.
For example, Japanese Patent Application Publication No. 2017-138821 describes, in order to cancel vibration overshoot that occurs during positioning control of a machine by a motor, a vibration suppression method of adding a compensation torque command corresponding to vibration having a phase opposite to the above vibration to a torque command of the motor.
On the other hand, there are many mechanical facilities provided with a plurality of coupled movable elements individually driven by a plurality of motors, and other movable elements may be vibrated by driving any one of the movable elements. On the other hand, even if the vibration suppression method of the above prior art is applied, a vibration suppression effect cannot be obtained because the cause of the vibration is the driving of the movable element on the other axis.
According to one aspect of the present invention, a machine control system includes a first movable element, a second movable element, and control circuitry. The first movable element is configured to be driven by a first motor. The second movable element is configured to be driven by a second motor which is connected to the first motor so that a jerk to be generated by the first motor is applied to the second movable element. The control circuitry is configured to generate a first control command to control the first motor and to generate a second control command to control the second motor according to the jerk.
According to another aspect of the present invention, a machine controller includes control circuitry which is configured to generate a second control command to control the second motor according to a jerk to be generated by a first motor and to be applied to the second motor.
According to further aspect of the present invention, a vibration suppression command generation method executed by an arithmetic device included in a machine controller that each individually controls a plurality of motors includes executing generation of a vibration suppression command added to a nomial control command in a second control command to drive a second motor according to a jerk to be generated by a first motor and to be applied to the second motor.
Hereinafter, an embodiment will be described with reference to the drawings.
First, by referring to
In
The controller 1 is constituted of a computer (see
The servo amplifiers 2A and 2B are constituted of a computer (see
The linear motors 3A and 3B are direct-acting motors and generate a rectilinear thrust for driving the drive machine 4 with the drive power supplied from the servo amplifiers 2A and 2B. The linear motors 3A and 3B are configured by a combination of a rectangular flat-plate-shaped stator 31 that is long in one direction and movers 32A and 32B that can reciprocate in a longitudinal direction on the stator 31. In this example, a large number of permanent magnets (not shown) in which magnetic poles are alternately arranged in a longitudinal direction are provided on the stator 31 side, and an armature (not shown) capable of generating a rectilinear magnetic field by the drive power supplied from the servo amplifiers 2A and 2B is provided on the sides of the movers 32A and 32B. The linear motors 3A and 3B in this example are individually provided with linear scales (not particularly shown) for detecting output positions of the movers 32A and 32B.
The drive machine 4 is a mechanical structure that is connected to the movers 32A and 32B of the linear motors 3A and 3B and is mechanically driven by the drive force (thrust in this example). In the drawing, the drive machine 1 is schematically abbreviated with weights W1 and W2 fixed on the movers 32A and 32B, respectively.
In the example of the machine control system 100 of the present embodiment, the linear motors 3A and 3B, which are drive sources of the drive machine 4, individually reciprocate the two movers 32A and 32B on the common stator 31. That is, the two linear motors 3A and 3B that share the stator 31 are included. Here, a linear motor provided with one mover (the mover 32A on the right front side in the drawing in the illustrated example) is referred to as the first motor 3A, and a linear motor provided with the other mover (the mover 32B on the left back side in the drawing in the illustrated example) is referred to as the second motor 3B. The first motor 3A is independently driven and controlled by receiving a supply of a drive power from the first servo amplifier 2A, and the second motor 3B is independently driven and controlled by receiving a supply of a drive power from the second servo amplifier 2B. The controller 1 outputs appropriate control commands to the first servo amplifier 2A and the second servo amplifier 2B, respectively, and thereby can control the two linear motors 3A and 3B in a coordinated manner to drive and control the entire drive machine 4 in a predeteiniined sequence.
The control command transmitted and received between the controller 1 and each of the servo amplifiers 2A and 2B includes a normal control command that directly commands operation of the movers 32A and 32B of the corresponding linear motors 3A and 3B, and a vibration suppression command for suppressing vibration of the movers 32A and 32B. For example, as shown in the illustrated example, when a jerk is generated in the normal control command output from the controller 1 to the first motor 3A, the vibration suppression command based on the jerk in the first motor 3A is output together with the corresponding no nal control command to the second motor 3B in which generation of vibration under the influence is predicted. Such control command transmission/reception between the controller 1 and each of the servo amplifiers 2A and 2B is performed by synchronous communication, which will be described later, in order to ensure real-time performance of motion control in the drive machine 4.
In the following description, combinations of the corresponding linear motors 3A and 3B and the servo amplifiers 2A and 2B are collectively referred to as a drive shaft control system. In the above description, the movers 32A and 32B of the linear motors 3A and 3B and a movable section of the drive machine 4 that is connected to the movers 32A and 32B and operates correspond to movable elements described in the claims. The servo amplifiers 2A and 2B correspond to motor control devices described in the claims. The controller 1 corresponds to host control devices described in the claims. The whole summarizing the controller 1 and the plurality of servo amplifiers 2A and 2B corresponds to machine control devices described in the claims. The control command output from the controller 1 toward the first servo amplifier 2A in this example corresponds to first control commands described in the claims. The control command output from the controller 1 toward the second servo amplifier 2B in this example corresponds to second control commands described in the claims.
Processing and the like in the controller 1, the first servo amplifier 2A, the second servo amplifier 2B and the like are not limited to the example of allotment of the processing, but, for example, they may be processed in a smaller number of control devices (for example, one machine control device) or in control devices furthermore segmentalized. The processing of the controller 1 (or the servo amplifiers 2A and 2B) may be implemented by a program executed by a CPU 901 (arithmetic device; see
Many general mechanical equipment including industrial machines have a configuration including a plurality of movable elements individually driven by the plurality of motors 3A and 3B as in the present embodiment. The plurality of motors 3A and 3B are individually driven and controlled by the plurality of servo amplifiers 2A and 2B, and the plurality of servo amplifiers 2A and 2B are respectively controlled in a coordinated manner based on a control command output from the host controller 1.
In the machine control system 100 thus configured, when any one of the movable elements is operated by driving the motors 3A and 3B, the reaction force is propagated to cause other movable elements to vibrate. So far, each drive shaft control system independently performs vibration suppression control on vibration generated in such a mechanical system by a disturbance suppression function (such as using an observer) included in the servo amplifiers 2A and 2B.
However, for example, in a precision equipment manufacturing operation as performed in recent semiconductor manufacturing apparatuses and the like, very high operation accuracy up to μm order is required. On the other hand, as described above, if each drive shaft control system just independently executes the vibration suppression control by the disturbance suppression function, a response will be delayed since correspondence is performed after vibration is actually received. There is a risk that a sufficient vibration suppression effect cannot be obtained because, for example, high vibration suppression accuracy corresponding to a generation factor of a minute vibration such as a jerk cannot be obtained.
On the other hand, in the present embodiment, the controller 1 generates a second control command for driving and controlling the second motor 3B based on the jerk in the first control command for driving and controlling the first motor 3A.
In other words, in the controller 1 that monitors all control commands to be executed by each drive shaft control system, it is possible to grasp which drive shaft control system and movable element generate what jerk at what timing and whether this becomes a generation factor of vibration for the movable element of another drive shaft control system. Therefore, the controller 1 thus configured can generate the second control command that commands to the second motor 3B, which is the other drive shaft control system described above, so that vibration suppression control corresponding suitably to the generation timing and contents (magnitude, phase, etc.) of the jerk generated in the first motor 3A can be executed. Hereinafter, a method for performing such vibration suppression control will be described in detail.
The generation of a jerk in the example shown in
In the example shown in
Corresponding to such a velocity waveform, as shown in the second time chart from the top, a motor acceleration is generated with a rectangular waveform extending to a positive-value side (upper side in the drawing) during a period when the motor speed is accelerating, the motor acceleration is generated with a rectangular waveform extending to a negative-value side (lower side in the drawing) during a period when the motor speed is decelerating, and the motor acceleration is not generated during other periods when the motor is stopped or the motor speed is constant.
Corresponding to such an acceleration waveform, as shown in the third time chart from the top, a motor jerk is generated with a rectangular waveform extending to the positive-value side when the motor acceleration rises, the motor jerk is generated with a rectangular waveform extending to the negative-value side when the motor acceleration is lowered, and the motor jerk is not generated during other periods when the motor acceleration is 0 or constant. The magnitude of the jerk corresponds to a second-order time differential value of the velocity command, in other words, a value obtained by dividing an amount of change in the command unit of a movement position by the square value of a cycle period of the communication control cycle T. Both the motor acceleration and the motor jerk described above are sampled in cycle units of the communication control cycle T, and, in particular, since the motor acceleration is generated with a rectangular waveform, each motor jerk is represented by a pulse waveform for one cycle (instantaneous value with a symbol).
The reaction force against the jerk generated in the drive shaft control system on the vibrating side as described above becomes, for example, a vibrating force that propagates through the common stator 31 in the configuration of
Here, the controller 1 manages a control schedule of what control command is output at which cycle period for each of all the drive shaft control systems included in the machine control system 100. For this reason, the controller 1 can grasp which movable element of the drive shaft control system generates what jerk at what cycle period and becomes the vibrating side and whether the jerk becomes a generation factor of vibration for the movable element of another drive shaft control system that becomes the vibrated side. Therefore, the controller 1 may generate and output the vibration suppression command suitably corresponding to the generation timing and content (magnitude, phase, etc.) of the jerk generated in the first motor 3A on the vibrating side with respect to the second motor 3B on the vibrated side.
As a specific form of the vibration suppression command generated by the controller 1 by the above method, in the example of the present embodiment, the vibration suppression command is generated in the form of a thrust feedforward command input to the servo amplifier 2B so that an arbitrary vibration suppression force can be added to the linear motor 3B.
For example, when general position control processing executed in the servo amplifier 2B is expressed in a transfer function format, the processing becomes double loop processing of a position control feedback loop and a velocity control feedback loop as shown in
When a time corresponding to a plurality of the communication control cycles T is required until vibration is sufficiently attenuated after generated on the vibrated side, the servo amplifier 2B needs to continuously add the thrust feedforward command for vibration suppression control to a torque command during the plurality of cycles (hereinafter, referred to as an output cycle). Therefore, the controller 1 generates the thrust feedforward command in time series with a value obtained by sampling the substantially sinusoidal waveform of the vibration suppression force at the communication control cycle T, and continuously outputs the thrust feedforward command as the vibration suppression command during an appropriately set output cycle.
A specific content of the vibration waveform actually received on the vibrated side is affected by not only the generation content (for example, amplitude, phase, etc.) itself of the jerk on the vibrating side, which is the factor, but also various elements such as rigidity and connection configuration of mechanical elements connected between the drive shaft control systems on the vibrating side and the vibrated side, a mass ratio of each movable element, and an inter-shaft arrangement relationship (direction and distance) of the drive shaft control system. For this reason, it is desirable that the specific generation content of the thrust feedforward command be generated with a content corresponding to a mechanical relationship between the drive shaft control system on the vibrating side and the drive shaft control system on the vibrated side.
Here, in general, a sinusoidal waveform can be uniquely defined by three waveform parameters of amplitude, frequency, and phase. However, in the vibration of a substantially sinusoidal waveform generated on the vibrated side, the amplitude including its phase (positive and negative signs) is proportional to the amplitude of the jerk on the vibrating side, and the frequency depends on the mechanical relationship between the vibrating side and the vibrated side and attenuates with time. For this reason, when an effective thrust feedforward command is generated on the vibrated side, it is desirable to generate the thrust feedforward command with an amplitude obtained by multiplying an amplitude (a value increasingly and decreasingly changing in accordance with the normal control command) of the jerk generated on the vibrating side by an amplitude suitably set in advance and with a sinusoidal wavefortn defined by the frequency and output cycle suitably set in advance corresponding to a combination of the vibrating side and the vibrated side. In the example of the present embodiment, the wavefoiin parameters of the amplitude ratio, frequency, and output cycle are suitably set in advance by manual adjustment operation, for example, and stored in the controller 1 generating the vibration suppression command.
In a vibration suppression force waveform in an example shown in
In general motion control communication, when a time corresponding to a predetermined cycle of the communication control cycle T may be required from when the controller 1 outputs a command until the servo amplifier 2B actually executes the command. Depending on the mechanical relationship between the vibrating side and the vibrated side, a time corresponding to a predetermined cycle may be required for propagation of mechanical vibration between the vibrating side and the vibrated side. On the other hand, when the controller 1 outputs a vibration suppression command, the controller 1 outputs the vibration suppression command at a cycle period offset by the number of cycles (−2 T in the illustrated example) suitably set in advance from a cycle period A at which a jerk is generated. Since this output offset cycle depends on a communication control function between the controller 1 and the servo amplifier 2B, the mechanical relationship between the vibrating side and the vibrated side, and the like, this parameter is also suitably set in advance by manual adjustment operation, for example, and stored in the controller 1.
It is desirable that in the anti-phase waveform of the vibration suppression force, the vibration waveform fits as well as possible the amplitude, the frequency, and the output cycle. However, a constant vibration suppression effect can be obtained simply by outputting the vibration suppression force, whose polarity is opposite to the instantaneous value of the vibration waveform at least in a predetermined cycle period, for one communication control cycle T.
For example, as shown in the time chart of
The controller 1 calculates a waveform amplitude of a vibration suppression command waveform by multiplying the magnitude of the jerk, generated by the control command as described above, by the amplitude ratio set in advance as appropriate. In the example of the present embodiment, in addition, the waveform amplitude of the vibration suppression force waveform that is an actual vibration suppression command is calculated based on a ratio obtained by normalizing the maximum amplitude. For example, in the example shown in
Consequently, for example, the amplitude of the vibration suppression force waveform to be added to the vibrated side corresponding to a case where the acceleration is 50% in the control command may be calculated as 50% of the maximum amplitude (see the central time chart column in the drawing). The amplitude of the vibration suppression force waveform to be added to the vibrated side corresponding to a case where the acceleration is 25% in the control command may be calculated as 25% of the maximum amplitude (see the right time chart column in the drawing). Then, an instantaneous value of the thrust feedforward command of the vibration suppression command to be output at each cycle period may be calculated by multiplying the waveform amplitude value calculated as described above by an angular velocity corresponding to the waveform frequency and a sinusoid function at an elapsed cycle.
For example, as shown in the time chart of
There are cases where a jerk is frequently generated at short time intervals as in the time chart shown in
For example, when the controller 1 outputs a control command such as an interpolation operation, as shown in the time chart of
As described above, according to the machine control system 100 of the present embodiment, a machine control device (in this example, a collective term for a plurality of the servo amplifiers 2A and 2B and the controller 1) that controls the drive of the machine control system 100 generates the second control command for driving and controlling the second motor 3B based on the jerk in the first control command for driving and controlling the first motor 3A. Consequently, for the second motor 3B of the drive shaft control system on the vibrated side, it is possible to generate the second control command to execute vibration suppression control suitably corresponding to the generation timing and contents (magnitude, phase, etc.) of the jerk generated in the first motor 3A on the vibrating side. As a result, it is possible to improve a mutual vibration suppression function among the plurality of drive shaft control systems.
Particularly in the present embodiment, the machine control device generates a second control command in which the vibration suppression command based on the jerk in the first control command is added to the normal control command for driving and controlling the second motor 3B. Consequently, the normal control of the position control and velocity control executed by the normal control command for the second motor 3B can be executed, as well as the vibration suppression control in the vibration suppression command suitably corresponding to the reaction force (thrust, etc.) received by an externally generated jerk.
In the present embodiment, in particular, the machine control device includes the plurality of servo amplifiers 2A and 2B that individually drive and control the plurality of motors 3A and 3B, and the controller 1 that generates the first control command and the second control command to the plurality of servo amplifiers 2A and 2B. The controller 1 adds, as the thrust feedforward command, the vibration suppression command in the second control command to the thrust command of the normal control that drives and controls the second motor 3B. The controller 1 generates the thrust feedforward command based on the jerk in the first control command.
As described above, the machine control device is configured with the plurality of servo amplifiers 2A and 2B that control the drive of each of the motors 3A and 3B, and the controller 1 that integrally controls the plurality of servo amplifiers 2A and 2B, whereby machine control processing of the entire machine control system 100 can be functionally shared by each device. Then, the controller 1 generates a vibration suppression command in the form of the thrust feedforward command, and the servo amplifier 2B adds the thrust feedforward command, input as the vibration suppression command, to the thrust command, so that the normal control of the position control and the velocity control separately executed by the servo amplifier 2B is not affected, and the vibration suppression control can be executed with the thrust suitably corresponding to the reaction force (thrust) received by an externally generated jerk.
The controller 1 that monitors the control command and the vibration suppression command to each of the drive shaft control systems on the vibrating side and the vibrated side easily generates the thrust feedforward command with contents corresponding to the mechanical relationship between the two drive shaft control systems and can output itself as the vibration suppression command to the servo amplifier 2B on the vibrated side. Then, in the servo amplifier 2B to which such a vibration suppression command is input, it is only necessary to add the vibration suppression command in the form of the thrust feedforward command to the thrust command as it is, so that processing load of the servo amplifier 2B can be reduced.
Although not particularly shown, the servo amplifier 2B may generate the thrust feedforward command In this case, the servo amplifier 2B stores in advance the waveform parameters (amplitude ratio, frequency, and output cycle) that define the sinusoidal waveform of the vibration suppression force, and the controller 1 outputs, as the vibration suppression command, information, corresponding to the magnitude (sign, amplitude) of the jerk generated on the vibrating side, at a suitable cycle period. Then, the servo amplifier 2B may generate the corresponding thrust feedforward command for each cycle period based on the waveform parameter and the vibration suppression command and add the thrust feedforward command to the thrust command.
In the present embodiment, in particular, the vibration suppression command is generated in time series with a value sampled at the communication control cycle T between the controller 1 and the servo amplifier 2B. Consequently, even with the servo amplifier 2B that performs motion control processing for each of the communication control cycles T, vibration suppression control with the vibration suppression force waveform over a plurality of the communication control cycles T is enabled.
In the present embodiment, in particular, the vibration suppression command is output at a cycle period offset by a predetermined number of cycles from a generation cycle period of a jerk in the communication control cycle T. This can cause the servo amplifier 2B to start executing the vibration suppression control suitably in response to the timing when the movable element on the vibrated side actually starts to vibrate.
In the present embodiment, in particular, the vibration suppression command is generated with an anti-phase waveform (at least positive and negative may be inverted) of the vibration waveform generated in the movable element due to a jerk. As described above, when the vibration suppression command is generated with the thrust feedforward command with the anti-phase waveform based on the vibration waveform of the movable element on the vibrated side, instead of using the jerk as a reference, it is possible to perform control so as to cancel vibration generated in the movable element.
In the present embodiment, in particular, the anti-phase wavefothi (vibration suppression force waveform) of the vibration waveform on the vibrated side is generated with a substantially sinusoidal waveform defined by the waveform parameter of at least one of the amplitude ratio with respect to a jerk, the frequency, and the output cycle. Consequently, the waveform parameters of the amplitude ratio, the frequency, and the output cycle are suitably set in advance by manual adjustment operation, for example, and if the amplitude of the jerk generated can be specified, the thrust feedforward command of a sinusoidal waveform effective for the vibration suppression function can be generated.
In the present embodiment, in particular, the vibration suppression command is generated with a superimposed waveform of anti-phase waveforms respectively corresponding to a predetermined number of jerks generated in the immediately past. Consequently, even with respect to the vibration waveform synthesized by a plurality of jerks generated at short time intervals, the servo amplifier 2B functionally cancels the vibration with a single vibration suppression command (thrust feedforward command) input for each of the communication control cycles T and can perform vibration suppression control.
In the present embodiment, in particular, the vibration suppression command is generated corresponding to the jerk that is equal to or greater than the threshold of the effective minimum jerk. Consequently, for example, even when velocity control is performed such that a minute jerk is frequently generated on the vibrating side, control stability of the drive shaft control system can be improved while maintaining a sufficient vibration suppression function on the vibrated side.
In the example of the present embodiment, the description has been made on the assumption that one first motor 3A is the vibrating side and the other second motor 3B is the vibrated side. However, conversely, there are many cases where there is a causal relationship of vibration with each other so that the second motor 3B is the vibrating side and the first motor 3A is the vibrated side. In either case, the controller 1 may generate the control command on the vibrated side based on the jerk on the vibrating side. If there is no symmetry in a mechanical relationship that affects the vibration waveform of the movable element, that is, if the vibration waveform (waveform parameter, the number of offset cycles) changes when the vibrating side and the vibrated side are reversed, the controller 1 stores the waveform parameter and the number of offset cycles for each combination (in this example, two ways) of directional relationships between the vibrating side and the vibrated side and generates a vibration suppression command having the corresponding contents.
The thrust feedforward command, which is a vibration suppression command, may be input at any cycle period regardless of whether the drive shaft control system on the vibrated side is stopped or operating (movable element is moving). The amplifier 2B may perform control in response to a thrust command, obtained by adding the thrust feedforward command of the vibration suppression command, in real time.
In the above embodiment, the vibration suppression command corresponding to the generation of a jerk in the first control command (normal control command) to the vibrating side is generated, and this vibration suppression command is added to only the normal control command to the vibrated side and output as the second control command. However, the present invention is not limited thereto. For example, even in the control command output from the controller 1 to any drive shaft control system, the controller 1 may output the control command in a form in which the vibration suppression command is always added to the normal control command. In this case, while the jerk is not generated on one drive shaft control system side, the vibration suppression command (thrust feedforward command) on the other drive shaft control system side may be generated with a zero value.
In the vibration suppression method of the present embodiment, the mechanical arrangement relationship between the vibrating side and the vibrated side is not limited to the arrangement relationship on the same straight line as in the example shown in
The motor used in the drive shaft control system is not limited to a direct-driven type linear motor, and the vibration suppression method of the present embodiment can be applied even when a rotary motor is used. In this case, the thrust command in the loop processing shown in
The disclosed embodiment is not limited to that described above, but may be modified in various forms so long as it does not deviate from the scope and the technical concept. Such modified examples will be described below.
<Case where Three or More Drive Shaft Control Systems are Provided>
In the above embodiment, the machine control system including the two drive shaft control systems has been described. However, as shown in
As described above, when the drive shaft control system having three or more shafts is provided, when any one drive shaft control system becomes the vibrating side when the jerk is generated in the control command in the drive shaft control system, the controller 201 may output the vibration suppression command to all other drive shaft control systems as the vibrated side.
However, in many cases, for each combination of two drive shaft control systems that have a relationship between the vibrating side and the vibrated side, a mechanical relationship between them differs. The illustrated example shows a case where the drive shaft control system of the second motor 203B is the vibrating side and the drive shaft control system of each of the other first motor 203A and the third motor 203C is the vibrated side. Due to the difference in mass between the weights W1, W2, and W3 described above and the difference in the motor shaft direction, the mechanical relationship in a combination of the second motor 203B and the first motor 203A is different from the mechanical relationship in a combination of the second motor 203B and the third motor 203C. Although not particularly illustrated, for example, when the first motor 203A is on the vibrating side, due to a difference in installation distance between shafts, the mechanical relationship in the combination of the first motor 203A and the second motor 203B is different from the mechanical relationship in a combination of the first motor 203A and the third motor 203C.
As described above, the waveform shape (amplitude ratio, frequency, output cycle) of the vibration suppression force waveform serving as a reference for the vibration suppression command, and the cycle period (the number of offset cycles) at which the vibration suppression command is output depend on the mechanical relationship including directionality between the vibrating side and the vibrated side. For this reason, the vibration suppression command output to each of the drive shaft control systems on the vibrated side is desirably generated with contents corresponding to a shaft combination with the drive shaft control system on the vibrating side and the directional relationship individually for each drive shaft control system. In the illustrated example, a vibration suppression command with a content corresponding to a shaft combination in which the second motor 203B is on the vibrating side and the first motor 203A is on the vibrated side with respect to the first motor 203A on the vibrated side and the directional relationship is generated. Similarly, a vibration suppression command with a content corresponding to a shaft combination in which the second motor 203B is on the vibrating side and the third motor 203C is on the vibrated side with respect to the third motor 203C on the vibrated side and the directional relationship is generated. For this reason, the controller 201 stores the waveform parameters and the number of offset cycles for each of all the number of shaft combinations and the number of directional relationships (in this example, 3 combinations×2 directions=6 types) that form a pair in a plurality of drive shaft control systems and generates the vibration suppression command with the corresponding contents.
When the two drive shaft control systems are on the vibrating side at short time intervals, the vibration suppression command corresponding to the superimposed waveforms is generated on the other vibrated side. When the servo amplifiers 202A and 202C generate the torque feedforward command, the controller 201 generates a vibration suppression command that combines information on which drive shaft control system is on the vibrating side and the magnitude of the jerk and outputs the vibration suppression command to the servo amplifiers 202A and 202B. Although not particularly illustrated, the same vibration suppression method can be applied even when a drive shaft control system having four or more shafts is provided.
Next, an example of a hardware configuration of the controller 1,201 that realizes processing by the program executed by the CPU 901 described above will be described with reference to
As shown in
The program can be recorded in the ROM 903, the RAM 905, and the storage device 917, for example.
The program can also temporarily or permanently (non-temporarily) be recorded in a removable recording medium 925 such as magnetic disks including flexible disks, various optical disks including CDs, MO disks, and DVDs, and semiconductor memories. The recording medium 925 as described above can be provided as so-called packaged software. In this case, the program recorded in the recording medium 925 may be read by the drive 919 and recorded in the storage device 917 through the I/O interface 911, the bus 909, etc.
The program may be recorded in, for example, a download site, another computer, or another storage device (not shown). In this case, the program is transferred through a network NW such as a LAN and the Internet, and the communication device 923 receives this program. The program received by the communication device 923 may be recorded in the storage device 917 through the I/O interface 911, the bus 909, etc.
The program may be recorded in appropriate externally-connected equipment 927, for example. In this case, the program may be transferred through the appropriate connection port 921 and recorded in the storage device 917 through the I/O interface 911, the bus 909, etc.
Then, the CPU 901 executes various processing in accordance with the program recorded in the storage device 917 to implement control processing by the controller 1,201 (or servo amplifier 2,202) described above. In this case, for example, the CPU 901 may directly read and execute the program from the storage device 917 or may execute the program once loaded in the RAM 905. In the case where the CPU 901 receives the program through, for example, the communication device 923, the drive 919, or the connection port 921, the CPU 901 may directly execute the received program without recording in the storage device 917.
The CPU 901 may execute various processing based on a signal or information input from the input device 913 such as a mouse, a keyboard, and a microphone (not shown) as needed.
Then, the CPU 901 outputs the result of executing the above processing from the output device 915 such as a display device or an audio output device. Furthermore, the CPU 901 may transmit the processing result via the communication device 923 or the connection port 921 as necessary, or may record the processing result in the storage device 917 or the recording medium 925.
If terms “vertical,” “parallel,” “plane,” etc. are used in the above description, these terms are not used in the exact meanings thereof. Specifically, these terms “vertical,” “parallel,” and “plane” allow tolerances and errors in design and producing and have meanings of “approximately vertical,” “approximately parallel,” and “approximately plane.”
If terms “same,” “equal,” “different,” etc. in relation to a dimension and a size of the appearance, a shape, a position, etc. are used in the above description, these terms are not used in the exact meaning thereof. Specifically, these terms “same,” “equal,” and “different” allow tolerances and errors in design and producing and have meanings of “approximately the same,” “approximately equal,” and “approximately different.”
The present invention is not limited to the above-described embodiments. Within the scope of the present invention, the above-described embodiments can be freely combined, as well as any components in the embodiments can be modified or omitted.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2019-081162 | Apr 2019 | JP | national |
