Control device, control system, and control method
By calculating the distance slope in the control device and performing interpolation calculation, the problem of inaccurate actuator control in laser processing is solved, and high-precision laser control in the case of jitter and periodic variation is realized.
Patent Information
- Application Number
- CN202380029597.X
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-04-01
- Filing Date
- 2023-03-08
- Publication Date
- 2024-11-08
AI Technical Summary
The prior art is difficult to achieve fine control of the actuator in laser processing, especially in the face of jitter and periodic changes, resulting in inaccurate errors and control of distance interpolation values.
By introducing a storage unit, a clock generation unit, a calculation unit and a clock control unit into the control device, the distance slope is calculated and interpolated to ensure that the corresponding command is output when the target distance is reached. And control the output of the interpolated clock within a predetermined clock cycle to suppress the impact of jitter on control.
Achieve more fine control accuracy, reduce the impact of jitter on distance interpolation value, and ensure the stability and accuracy of the laser opening and closing timing.
Smart Images

Figure CN118922795A_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to a control device for controlling an actuator, a control system including the control device, and a control method for the actuator. Background Art
[0002] Conventionally, laser processing has been performed using a processing program that utilizes a control code. For example, Japanese Patent Application Laid-Open No. 02-063692 (Patent Document 1) discloses a technique for defining processing conditions as parameters to control the output, moving speed, etc. of a laser oscillator.
[0003] Prior art literature
[0004] Patent Literature
[0005] Patent Document 1: Japanese Patent Application Laid-Open No. 02-063692 Summary of the Invention
[0006] Problems to be solved by the invention
[0007] The present invention provides a control device capable of performing more precise control.
[0008] Means for solving problems
[0009] According to one example of the present invention, a control device for controlling an actuator is provided. The control device includes: a storage unit that obtains a new distance command value at a first timing indicated by a first clock and stores it as the latest value, and stores the immediately preceding latest value as the previous value; a second clock generation unit that generates a second clock; a first calculation unit that calculates a distance slope based on the latest and previous values of the distance command value and the number of second clocks within one cycle of the first clock; a second calculation unit that calculates an interpolated distance value by sequentially adding the distance slope to the previous value of the distance command value at a second timing indicated by the second clock; a first command generation unit that, when the interpolated distance value reaches a target distance, outputs a first command corresponding to the target distance; and a clock control unit that, when the number of second clocks generated within one cycle of the first clock reaches a predetermined set value, stops outputting the second clock until the next cycle of the first clock arrives.
[0010] According to this structure, by sequentially calculating the distance interpolation values at the second timing indicated by the second clock, it is possible to more accurately determine whether the target distance has been reached, and the number of second clocks generated within one cycle of the first clock is limited to a set value. Therefore, even if jitter occurs in the first clock, the influence on the calculation of the distance interpolation value can be suppressed.
[0011] The control device may further include a measuring unit that measures the number of second clocks generated within one cycle of the first clock. According to this configuration, since the number of second clocks is measured, the distance interpolation value can be appropriately calculated according to the situation.
[0012] The number of second clocks generated within one cycle of the first clock may be a predetermined fixed value. According to this configuration, since the number of second clocks is a predetermined fixed value, operation verification can be performed more easily.
[0013] The period of the first clock may be set to an integral multiple of the period of the second clock. According to this configuration, the distance interpolation value can be calculated at a uniform timing within the period of the first clock.
[0014] Alternatively, the clock control unit may start generating the second clock at the third timing indicated by the first clock. With this configuration, even if the period of the first clock is lengthened due to jitter, the second clock can be started at a predetermined timing in the next period.
[0015] The control device may further include a second command generating unit that generates a second command for specifying a position according to the specified trajectory. With this configuration, the position of the actuator or the like can be controlled according to the specified trajectory.
[0016] The first command generating unit may output an instruction to open or close as a command. According to this configuration, the opening or closing of the actuator can be controlled at the timing when the target distance is reached.
[0017] The control device may provide a user interface for accepting settings of the first clock cycle and the second clock cycle. With this configuration, the user can set the first clock cycle and the second clock cycle in consideration of jitter tolerance and control accuracy.
[0018] A control system according to another embodiment of the present invention includes an actuator and a control device for controlling the actuator. The control device includes: a storage unit that obtains a new distance command value at a first timing indicated by a first clock and stores it as the latest value, and stores the immediately preceding latest value as the previous value; a second clock generation unit that generates a second clock; a first calculation unit that calculates a distance slope based on the latest and previous values of the distance command value and the number of second clocks within one cycle of the first clock; a second calculation unit that calculates an interpolated distance value by sequentially adding the distance slope to the previous value of the distance command value at a second timing indicated by the second clock; a command generation unit that outputs a command corresponding to a target distance when the interpolated distance value reaches the target distance; and a clock control unit that, when the number of second clocks generated within one cycle of the first clock reaches a predetermined set value, stops outputting the second clock until the next cycle of the first clock arrives.
[0019] According to another example of the present invention, a method for controlling an actuator is provided. The method includes the following steps: at a first timing indicated by a first clock, obtaining a new distance command value and storing it as the latest value, and storing the immediately preceding latest value as the previous value; calculating a distance slope based on the latest and previous values of the distance command value and the number of second clocks within one cycle of the first clock; at a second timing indicated by a second clock, sequentially adding the distance slope to the previous value of the distance command value to calculate an interpolated distance value; when the interpolated distance value reaches a target distance, outputting a command corresponding to the target distance; and when the number of second clocks generated within one cycle of the first clock reaches a predetermined set value, stopping output of the second clock until the next cycle of the first clock arrives.
[0020] Effects of the Invention
[0021] According to the present invention, a control device and the like capable of performing more precise control can be realized. BRIEF DESCRIPTION OF THE DRAWINGS
[0022] Figure 1 It is a schematic diagram showing a configuration example of a control system according to this embodiment.
[0023] Figure 2 It is a schematic diagram showing a main hardware configuration example of the control system according to the present embodiment.
[0024] Figure 3 Schematic diagram showing a functional configuration example of a main control unit of the control system according to the present embodiment.
[0025] Figure 4 This is a schematic diagram showing a functional configuration example of a laser control unit in the control system according to this embodiment.
[0026] Figure 5This is a diagram for explaining the calculation of the distance slope and the on / off control of the laser in the control system of this embodiment.
[0027] Figure 6 This is a timing chart showing an operation example in the control system of this embodiment.
[0028] Figure 7 This is a diagram for explaining the measurement of the interpolation clock number in the control system of this embodiment.
[0029] Figure 8 This is a timing chart showing an operation example when the period of the synchronization clock becomes short in the control system of this embodiment.
[0030] Figure 9 This is a timing chart showing an operation example when the period of the synchronization clock becomes long in the control system of this embodiment.
[0031] Figure 10 This is a flowchart showing the processing steps of the main processing executed by the laser control unit of the control system of this embodiment.
[0032] Figure 11 This is a flowchart showing the processing steps of the measurement processing of the interpolation clock number executed by the laser control unit of the control system of this embodiment.
[0033] Figure 12 This is a schematic diagram showing an example of the user interface screen displayed on the operation display device of the control system of this embodiment. Detailed Embodiment
[0034] The embodiments of the present invention will be described in detail with reference to the accompanying drawings. In addition, the same or corresponding parts in the drawings are denoted by the same reference numerals, and their descriptions will not be repeated.
[0035] <A. Application Example>
[0036] First, an example of the scenario where the present invention is applied will be described.
[0037] [[ID=
[0039] Laser processing of workpiece 4 combines workpiece position adjustment by the XY stage 20 with adjustment of the irradiation position of the laser light generated by laser 30 by the galvanometer mirror 40. Adjustment of the workpiece 4 by the XY stage 20 involves a relatively large displacement and a relatively long response time. In contrast, adjustment of the irradiation position by the galvanometer mirror 40 involves a relatively small displacement and a relatively short response time.
[0040] The control device 10 includes a main control unit 100 , a stage control unit 200 , and a laser control unit 300 .
[0041] The main control unit 100 is equivalent to executing the application program 110 (see Figure 2 The application program 110 is arbitrarily created according to the control target mechanism and the workpiece 4. The execution result of the application program 110 executed by the main control unit 100 is used to generate control signals in the stage control unit 200 and the laser control unit 300.
[0042] An operation display device 400 may be connected to the control device 10 , and the operation display device 400 may output instructions to the control device 10 in accordance with user operations and output calculation results in the control device 10 .
[0043] The XY table 20 includes a plate 22 on which the workpiece 4 is placed, and a servo motor 24-1 and a servo motor 24-2 (hereinafter sometimes collectively referred to as "servo motor 24") for driving the plate 22. Figure 1 In the example shown, the servo motor 24 - 1 displaces the plate 22 in the X-axis direction, and the servo motor 24 - 2 displaces the plate 22 in the Y-axis direction.
[0044] The servo motor 24 is controlled by the control device 10. More specifically, the table control unit 200 controls the servo drivers 26-1 and 26-2 (see FIG. 1 ) that drive the servo motors 24-1 and 24-2 via the control line 51. Figure 2 ) (hereinafter sometimes collectively referred to as "servo driver 26"). Outputs a servo command signal 510. In addition, the workbench control unit 200 obtains encoder output information 520 from encoders 28-1, 28-2 (hereinafter sometimes collectively referred to as "encoder 28") connected to the servo drivers 26-1, 26-2, respectively, via a control line 52.
[0045] The laser control unit 300 is connected to the laser 30 via the control line 53, and outputs a laser control signal 530 indicating on / off to the laser 30. In addition, the laser control unit 300 is connected to the galvanometer mirror 40 via the communication line 54, and outputs a mirror control signal 540 indicating the irradiation position to the galvanometer mirror 40. The galvanometer mirror 40 includes an X-axis scanning mirror 43, a Y-axis scanning mirror 45, and a lens 47. The light irradiated from the laser 30 propagates in the order of the lens 47, the Y-axis scanning mirror 45, and the X-axis scanning mirror 43, and is projected onto the XY stage 20.
[0046] The X-axis scanning mirror 43 is adjusted in the angle of the reflection surface by the X-axis scanning motor 42, and the Y-axis scanning mirror 45 is adjusted in the angle of the reflection surface by the Y-axis scanning motor 44. The lens 47 is adjusted in the relative distance from the laser 30 by the Z-axis scanning motor 46.
[0047] <B. Hardware Structure Example of Control System 1>
[0048] Next, a hardware structure example of the control system 1 of the present embodiment will be described.
[0049] Figure 2 It is a schematic diagram showing a main hardware structure example of the control system 1 of the present embodiment. As described above, the control device 10 includes a main control unit 100, a stage control unit 200, and a laser control unit 300.
[0050] The main control unit 100 includes a processor 102, a main memory 104, a memory 106, and a bus controller 112 as main components.
[0051] The memory 106 is composed of an SSD (Solid State Disk), a flash memory, etc., and stores, for example, a system program 108 for providing a basic program execution environment and an application program 110 arbitrarily created according to the workpiece 4.
[0052] Typically, the processor 102 is composed of a CPU (Central Processing Unit), a MPU (Micro-Processing Unit), etc., reads out the system program 108 and the application program 110 stored in the memory 106, and expands and executes them in the main memory 104, thereby achieving the overall control of the control system 1.
[0053] The main control unit 100 is electrically connected to the stage control unit 200 and the laser control unit 300 via an internal bus 114. The bus controller 112 mediates data communication based on the internal bus 114.
[0054] In addition, a structural example is shown in which the required processing is provided by executing a program by the processor 102, but part or all of the provided processing can also be implemented using a dedicated hardware circuit (for example, an ASIC (Application Specific Integrated Circuit) or an FPGA (Field-Programmable Gate Array)).
[0055] The stage control unit 200 generates and outputs a servo command signal 510 to the servo drivers 26 - 1 and 26 - 2 More specifically, the stage control unit 200 includes a stage control calculation unit 210 and a servo interface circuit 230 .
[0056] The stage control calculation unit 210 generates commands to be provided to the servo drivers 26-1 and 26-2 based on the calculation values (command values) calculated by the main control unit 100 executing the application program 110. The stage control calculation unit 210 is implemented using a calculation circuit composed of, for example, a processor, an ASIC, or an FPGA.
[0057] The servo interface circuit 230 outputs a servo command signal 510 according to a command from the main control unit 100. The servo command signal 510 includes information such as displacement, speed, and angular velocity for each control of the servo driver 26.
[0058] In addition, the servo interface circuit 230 obtains encoder output information 520 from each encoder 28. The encoder output information 520 includes position data indicated by the encoder 28. Alternatively, the encoder output information 520 may be transmitted via periodically transmitted frames.
[0059] The stage control calculation unit 210 calculates the state value (position, velocity, acceleration, etc.) of the servo driver 26 based on the encoder output information 520 and outputs it to the main control unit 100. The stage control calculation unit 210 includes a clock generation unit 220, which generates a synchronization clock 50 for synchronizing the main control unit 100, the stage control unit 200, and the laser control unit 300.
[0060] In addition, the stage control calculation unit 210 and the servo interface circuit 230 may also be implemented by a single ASIC or FPGA.
[0061] The laser control unit 300 generates and outputs a laser control signal 530 provided to the laser 30 and a laser control signal 530 provided to the galvanometer mirror 40. More specifically, the laser control unit 300 includes a laser / mirror control arithmetic unit 310, an output interface circuit 330, and a communication interface circuit 340.
[0062] The laser / mirror control arithmetic unit 310 generates commands to be provided to the laser 30 and the galvanometer mirror 40 based on the arithmetic values (command values) calculated by executing the application program 110 by the main control unit 100. The laser / mirror control arithmetic unit 310 is implemented, for example, by an arithmetic circuit composed of a processor, ASIC, FPGA, etc.
[0063] The laser / mirror control arithmetic unit 310 generates a laser control signal 530 and a mirror control signal 540.
[0064] The output interface circuit 330 outputs the laser control signal 530 provided to the laser 30 according to the command generated by the laser / mirror control arithmetic unit 310.
[0065] The communication interface circuit 340 outputs the mirror control signal 540 provided to the galvanometer mirror 40 according to the command generated by the laser / mirror control arithmetic unit 310.
[0066] In addition, the laser / mirror control arithmetic unit 310, the output interface circuit 330, and the communication interface circuit 340 can also be implemented by a single ASIC or FPGA.
[0067] <C. ON / OFF Control of Laser>
[0068] Next, the process of the control system 1 of the present embodiment outputting a laser control signal 530 indicating the ON / OFF of the laser 30 will be described.
[0069] Figure 3 is a schematic diagram showing a functional structure example of the main control unit 100 of the control system 1 of the present embodiment. The main control unit 100 performs arithmetic processing for moving the irradiation position of the laser 30 along a target trajectory.
[0070] More specifically, referring to Figure 3 , the main control unit 100 includes a trajectory generation unit 130 and a distance command calculation unit 132.
[0071] The trajectory generation unit 130 generates a trajectory regarding the irradiation position of the laser 30 based on a through-point sequence 134 composed of one or more through points.
[0072] The distance command calculation unit 132 calculates a distance command value for each cycle of the synchronous clock 50, corresponding to the generated trajectory. The calculated distance command values include a distance command value 350 for controlling the on / off state of the laser 30, and distance command values 352 and 354 for indicating the irradiation position of the laser 30. The distance command value 352 indicates the irradiation position on the X axis (the travel distance on the X axis to the irradiation position), and the distance command value 354 indicates the irradiation position on the Y axis (the travel distance on the Y axis to the irradiation position). The calculated distance command values are output to the laser control unit 300.
[0073] Distance command value 350 is a one-dimensional value, but may also be a two-dimensional value. In the case of a two-dimensional value, similarly to distance command values 352 and 354, command values indicating the movement distances of the X and Y axes may be output.
[0074] On the other hand, distance command value 352 and distance command value 354 are combined into a two-dimensional value, but may be a one-dimensional value similar to distance command value 350. However, in this case, information indicating the moving direction may also be output in addition to the one-dimensional moving distance.
[0075] In addition, for the sake of convenience, Figure 3 , the main control unit 100 also has a structure related to the control of the position of the workpiece by the XY stage 20.
[0076] Figure 4 This is a schematic diagram showing an example of the functional configuration of the laser control unit 300 of the control system 1 according to this embodiment. The laser control unit 300 generates a command (mirror control signal 540) for the irradiation position of the laser 30 based on the distance command value from the main control unit 100, and calculates (estimates) the current distance through interpolation to generate a command (laser control signal 530) to turn the laser 30 on or off.
[0077] More specifically, refer to Figure 4 The laser control unit 300 (laser / reflector control operation unit 310) includes a register 311, a distance difference calculation unit 312, a distance slope calculation unit 313, a distance interpolation unit 314, a comparison unit 315, an interpolation clock control unit 317, an interpolation clock number counter 319 and a position instruction generation unit 322.
[0078] Register 311 is a storage unit that receives a new distance command value 350 from main control unit 100 at the timing indicated by synchronous clock 50 (e.g., the falling edge of synchronous clock 50) and stores it as the latest value, while also storing the immediately preceding latest value as the previous value. More specifically, register 311 includes a latest value area 311A for storing the latest value of distance command value 350 and a previous value area 311B for storing the previous value. When a new distance command value 350 is stored in latest value area 311A, the value already stored in latest value area 311A is written to previous value area 311B. In other words, register 311 stores at least the two most recent distance command values 350.
[0079] The distance difference calculation unit 312 calculates the difference (distance difference) between the latest value and the previous value of the distance command value 350 stored in the register 311 .
[0080] The distance slope calculation unit 313 calculates the distance slope based on the latest and previous values of the distance command value 350 and the number of interpolation clocks 60 (interpolation clock count) within one cycle of the synchronous clock 50. Specifically, the distance slope calculation unit 313 calculates the distance slope for one interpolation clock by dividing the distance difference by the interpolation clock count. For example, the measured value of the interpolation clock 60 may be used as the interpolation clock count.
[0081] The distance interpolation unit 314 sequentially adds the distance slope to the previous value of the distance command value 350 at the timing indicated by the interpolation clock 60 (e.g., the rising edge of the interpolation clock 60) to calculate an interpolated distance value. Specifically, the distance interpolation unit 314 sequentially adds the value obtained by multiplying the distance slope by the elapsed time to the previous value of the distance command value 350 stored in the register 311 to calculate the current distance (interpolated distance value) calculated by interpolation.
[0082] When the calculated interpolated distance value reaches the target distance 316, the comparison unit 315 outputs a command corresponding to the target distance 316 (e.g., a command to turn the laser 30 on or off). Thus, the comparison unit 315 compares the interpolated distance value with the target distance 316 to determine whether it is time to turn the laser 30 on or off. The comparison unit 315 outputs the command to turn the laser 30 on or off as a command.
[0083] Alternatively, a plurality of target distances 316 may be prepared, such as the target distance 316 for turning on the laser 30 and the target distance 316 for turning off the laser 30 . The command generated by the comparison unit 315 is output as a laser control signal 530 via the output interface circuit 330 .
[0084] The interpolation clock control section 317 controls the generation of the interpolation clock 60. More specifically, the interpolation clock control section 317 includes an interpolation clock generation section 318 that generates the interpolation clock 60 and starts / stops the output of the interpolation clock 60 based on the timing of the rising / falling edge of the synchronous clock 50.
[0085] The interpolation clock counter 319 measures the period of the synchronous clock 50. More specifically, the interpolation clock counter 319 measures the number of interpolation clocks 60 generated within one period of the synchronous clock 50. In other words, the interpolation clock counter 319 calculates the denominator used to calculate the distance slope from the distance difference calculated by the distance difference calculation unit 312.
[0086] The position instruction generating unit 322 follows the specified trajectory ( Figure 3 The position command generating unit 322 generates a command (mirror control signal 540) for specifying the irradiation position of the laser 30 based on the trajectory generated by the trajectory generating unit 130 shown in FIG. The position command generating unit 322 generates a command for the laser 30, which is an example of an actuator, based on the distance command value 352 and the distance command value 354 from the main control unit 100. The position command generating unit 322 may also output the irradiation position of the laser 30 as a command. Furthermore, the command generated by the position command generating unit 322 is output as the mirror control signal 540 via the communication interface circuit 340.
[0087] Alternatively, the position command generating unit 322 may output the mirror control signal 540 after performing the same interpolation processing on the distance command value 352 and the distance command value 354 as on the distance command value 350. That is, the position command generating unit 322 may have the same configuration as the register 311, the distance difference calculating unit 312, the distance slope calculating unit 313, the distance interpolating unit 314, the comparing unit 315, the interpolation clock control unit 317, and the interpolation clock counter 319 for the distance command value 352 and the distance command value 354, respectively.
[0088] Figure 5 This is a diagram for explaining the calculation of the distance slope and the on / off control of the laser in the control system 1 of the present embodiment.
[0089] Reference Figure 5 At the timing indicated by the falling edge of the synchronous clock 50 (time t1, time t3, ...), the distance command value 1 is stored in the register 311. For example, the distance command value 2 stored at time t1 indicates the distance to be moved until time t4, which is the timing indicated by the next two rising edges of the synchronous clock 50. The distance command value 1 stored immediately before time t1 indicates the distance to be moved until time t2, which is the timing indicated by the next rising edge of the synchronous clock 50.
[0090] During the period from time t2 to time t4, after moving from the distance command value 1 to the distance command value 2, linear interpolation is performed, whereby the change in distance (distance interpolation value) within this period can be calculated. In addition, the distance interpolation process is reset at each timing (time t2, time t4, ……) represented by the rising edge of the synchronization clock 50.
[0091] The number of interpolations performed during the period corresponds to the interpolation clock number. That is, the interpolation clock number represents the interpolation granularity between adjacent timings.
[0092] In addition, the method of comparing the estimated current distance with the target distance and generating a command as described above is also referred to as the TBC (Table Base Compare) method.
[0093] <D. Operation Example and Possible Problems>
[0094] Next, the operation example of the control system 1 of the present embodiment and possible problems will be described.
[0095] Figure 6 It is a timing chart showing an operation example in the control system 1 of the present embodiment. Figure 6 An example is shown in which the distance command value increases by 1,000,000 each time in each cycle of the synchronization clock 50.
[0096] Refer to Figure 6 , the main control unit 100 outputs a distance command value (for example, 1,000,000) ( Figure 6 . In addition, either the laser control unit 300 accesses the distance command value output by the main control unit 100 via the internal bus 114, or the main control unit 100 writes the distance command value to the internal register of the laser control unit 300.
[0097] Triggered by the falling edge of the synchronization clock 50, the laser control unit 300 saves the distance command value in the latest value area 311A of the register 311 ( Figure 6 . Before saving to the latest value area 311A, the laser control unit 300 copies the distance command value already saved in the latest value area 311A to the previous value area 311B ( Figure 6 . Further, the laser control unit 300 calculates the distance slope based on the latest value and the previous value of the distance command value and the interpolation clock number ( Figure 6 .
[0098] Distance slope = (Change in distance) / (Change in time)
[0099] ={(latest value of distance command value)-(previous value of distance command value)} / (number of interpolation clocks)
[0100] =(1,000,000-0) / 500=2,000
[0101] Next, with the rising edge of the synchronous clock 50 as a trigger, the laser control unit 300 sets the previously calculated distance slope as the interpolation processing ( Figure 6 (5)), and set the last value of the distance instruction value as the initial value of the distance interpolation value ( Figure 6 (6)). Furthermore, the laser control unit 300 increases the distance slope for the distance interpolation value each time at each interpolation clock, thereby sequentially updating the distance interpolation value.
[0102] In addition, with the rising edge of the synchronous clock 50 as a trigger, the laser control unit 300 measures the interpolation clock number ( Figure 6 (7)). In addition, the interpolation clock number is updated sequentially at the rising edge of the synchronous clock 50.
[0103] Hereinafter, the above steps (1) to (7) are repeated.
[0104] Here, jitter may occur in the synchronous clock 50. The jitter generated in the synchronous clock 50 may affect the calculation of the distance interpolation value. The reason why the calculation of the distance interpolation value is affected will be described below.
[0105] For example, it is assumed that the period of the synchronous clock 50 becomes shorter due to jitter during the period from time t14 to time t16 ( Figure 6 (8)). For example, assume that the original period of the synchronous clock 50 is 50,000 [ns] and is shortened by 10 [ns]. If the period of the interpolated clock 60 is 100 [ns], the number of interpolated clocks measured by the laser control unit 300 is not the original 500, but 499 ( Figure 6 (9)).
[0106] As a result, the distance slope calculated by the laser control unit 300 is as follows ( Figure 6 (10)).
[0107] Distance slope = (change in distance) / (change in time)
[0108] ={(latest value of distance command value)-(previous value of distance command value)} / (number of interpolation clocks)
[0109] =(4,000,000-3,000,000) / 499=2,004
[0110] That is, the original distance slope is 2,000, but due to the jitter of the synchronous clock 50, it is calculated to be 2,004.
[0111] Next, triggered by the rising edge of the synchronization clock 50, the laser control unit 300 sets the previously calculated distance slope for interpolation processing ( Figure 6 as (11)), and sets the previous value of the distance command value as the initial value of the distance interpolation value ( Figure 6 as (12)).
[0112] Since the distance slope is larger than the original value, the distance interpolation value increases earlier than the original. As a result, during the period from time t18 to time t20, the distance interpolation value represents a value larger than the original. Then, the target distance is reached earlier, and the timing for turning on the laser is advanced ( Figure 6 as (13)).
[0113] In Figure 6 the example shown, the laser should be turned on at time t21, but it is turned on at time t21’ (=t21 - Δt).
[0114] Thus, due to the jitter of the synchronization clock 50, an error may occur in the distance interpolation value. Therefore, in the control system 1 of the present embodiment, the interpolation clock number counter 319 measures the interpolation clock number so that no error occurs in the distance interpolation value even if jitter occurs in the synchronization clock 50. Hereinafter, the measurement of the interpolation clock number by the interpolation clock number counter 319 will be described in detail. <E. Measurement of the interpolation clock number by the interpolation clock number counter 319>
[0115]
[0116] Next, the measurement of the interpolation clock number by the interpolation clock number counter 319 will be described. In the present embodiment, the generation of the interpolation clock 60 is controlled in synchronization with the synchronization clock 50.
[0117] Figure 7 is a diagram for explaining the measurement of the interpolation clock number in the control system 1 of the present embodiment.
[0118] Referring to Figure 7 , the period of the synchronization clock 50 is set to an integer multiple of the period of the interpolation clock 60. In Figure 7 the example shown, the period of the synchronization clock 50 is 50,000 [ns] (frequency is 20 [kHz]), and the period of the interpolation clock 60 is 100 [ns]. In addition, the period of the interpolation clock 60 can be set arbitrarily, but it is preferably determined in consideration of the resolution of the on / off control of the laser 30, etc.
[0119] Furthermore, the period of the synchronous clock 50 can be any value as long as it is an integral multiple of the period of the interpolation clock 60. The period of the synchronous clock 50 can also be set arbitrarily by the user. For example, the period of the synchronous clock 50 can be set within the range of 10,000 ns (frequency 100 kHz) to 100,000 ns (frequency 10 kHz).
[0120] Alternatively, the number of interpolation clocks 60 included in one cycle of the synchronous clock 50 may be set. In this case, the cycle of the interpolation clock 60 is determined by dividing the cycle of the synchronous clock 50 by the set number of interpolation clocks 60. For example, after setting the cycle of the synchronous clock 50 to 50,000 [ns], the number of interpolation clocks 60 is set to 500, thereby determining the cycle of the interpolation clock 60 to 100 [ns].
[0121] The duty cycle of the interpolation clock 60 is set as low as possible so as to absorb any jitter that may be generated in the synchronization clock 50. Figure 7 In the example shown, the duty ratio of the synchronous clock 50 is set to 10% (on period:off period=1:9).
[0122] The interpolation clock control unit 317 starts outputting the interpolation clock 60, triggered by the rising edge of the synchronous clock 50. Thereafter, when the number of interpolation clocks 60 generated within one cycle of the synchronous clock 50 (from the rising edge to the next rising edge) reaches a preset value (the set number of interpolation clocks), the interpolation clock control unit 317 stops outputting the interpolation clock 60 until the next cycle of the synchronous clock 50 (the rising edge of the synchronous clock 50) arrives.
[0123] Furthermore, for the interpolation clock output at the end of each cycle (the interpolation clock that reaches the set number of interpolation clocks in each cycle), the interpolation clock control section 317 adjusts the cycle by Δt corresponding to the jitter generated in the synchronous clock 50 .
[0124] Furthermore, the period of the interpolated clock 60 finally output is determined by the timing of the next rising edge of the synchronous clock 50. Specifically, the interpolated clock control unit 317 starts generating the interpolated clock 60 at the timing indicated by the synchronous clock 50 (e.g., the rising edge of the synchronous clock 50). Therefore, the period of the interpolated clock 60 can also be automatically adjusted by the timing of the rising edge of the synchronous clock 50.
[0125] In this way, the output of the interpolation clock 60 is adjusted synchronously with the periodic timing of the synchronization clock 50 (for example, the rising edge of the synchronization clock 50), and the deviation of the clock number of the measured interpolation clock 60 is suppressed, thereby suppressing the error that may be generated in the distance interpolation value and reducing the possibility of timing fluctuations in turning on / off the laser 30.
[0126] Figure 8 1 is a timing chart showing an example of operation when the cycle of the synchronous clock 50 is shortened in the control system 1 of this embodiment. Figure 8 and Figure 9 In FIG. 5 , it is assumed that the period of the interpolation clock 60 is 100 [ns] and the duty ratio is 10% (on period:off period=1:9).
[0127] Reference Figure 8 , the output of the interpolation clock 60 is started (times t31, t33, and t35) with the rising edge of the synchronous clock 50 as a trigger. In addition, the interpolation clock number counter 319 resets the measured value (interpolation clock number) with the rising edge of the synchronous clock 50 as a trigger, and sequentially increases the measured value according to the number of interpolation clocks 60 output.
[0128] As described above, the range slope is calculated using the rising edge of the synchronous clock 50 as a trigger, and the range interpolation value is calculated based on the calculated range slope using the rising edge of the synchronous clock 50 as a trigger. Then, when the calculated range interpolation value reaches the target distance 316, a command to turn the laser on or off is output.
[0129] The interpolation clock counter 319 determines whether the number of interpolation clocks 60 output since the immediately preceding rising edge of the synchronous clock 50 has reached a preset interpolation clock setting number. If not, the interpolation clock generator 318 continues to output the interpolation clock 60.
[0130] At time t33 , when the synchronous clock 50 rises, the interpolation clock control section 317 resets the synchronous clock 50 , and the interpolation clock generation section 318 starts outputting the interpolation clock 60 .
[0131] The same process is performed from time t33 to time t35. However, from time t33 to time t35, the cycle of the synchronous clock 50 is shortened by 10 [ns].
[0132] At time t35, when the synchronous clock 50 rises, the interpolation clock control unit 317 resets the synchronous clock 50, and the interpolation clock generation unit 318 starts outputting the interpolation clock 60. However, since the period of the synchronous clock 50 has shortened, the period of the interpolation clock 60 output just before time t35 is adjusted from the original 100 [ns] to 90 [ns].
[0133] Figure 9 This is a timing chart showing an example of operation when the cycle of the synchronous clock 50 is lengthened in the control system 1 of the present embodiment.
[0134] Reference Figure 9, triggered by the rising edge of the synchronous clock 50, the output of the interpolation clock 60 starts (at times t41, t43, t45). Additionally, the interpolation clock counter 319 is reset triggered by the rising edge of the synchronous clock 50 and incremented sequentially according to the number of the output interpolation clocks 60.
[0135] As described above, triggered by the rising edge of the synchronous clock 50, the distance slope is calculated. And triggered by the rising edge of the synchronous clock 50, based on the calculated distance slope, the calculation of the distance interpolation value starts. Then, when the calculated distance interpolation value reaches the target distance 316, an instruction to turn on or off the laser is output.
[0136] The interpolation clock control unit 317 determines whether the number of the interpolation clocks 60 output from the rising edge immediately preceding the synchronous clock 50 has reached the preset interpolation clock setting number. If it has not reached the interpolation clock setting number, the interpolation clock generation unit 318 continues to output the interpolation clocks 60.
[0137] At time t43, when the synchronous clock 50 rises, the interpolation clock control unit 317 resets the synchronous clock 50, and the interpolation clock generation unit 318 starts to output the interpolation clocks 60.
[0138] From time t43 to time t45, the same processing is also performed. However, from time t43 to time t45, the period of the synchronous clock 50 becomes 10 [ns] longer. Therefore, from the output of the last synchronous clock 50 to the rising edge of the synchronous clock 50 (time t45), there is a time (110 [ns]) longer than the period of the synchronous clock 50 (100 [ns]). However, when the last synchronous clock 50 is output, that is, when the number of the output interpolation clocks 60 reaches the preset interpolation clock setting number, the output of the synchronous clock 50 stops. As a result, the number of the interpolation clocks measured from time t43 to time t45 remains at 500, which is the same as the interpolation clock setting number.
[0139] Then, at time t45, when the synchronous clock 50 rises, the interpolation clock control unit 317 resets the synchronous clock 50, and the interpolation clock generation unit 318 starts to output the interpolation clocks 60. As a result, the period of the interpolation clock 60 output just before time t45 is adjusted from the original 100 [ns] to 110 [ns].
[0140] <F. Processing Steps>
[0141] Next, the processing steps executed by the laser control unit 300 of the control system 1 of the present embodiment will be described.
[0142] Figure 101 is a flowchart showing the processing steps of the main process executed by the laser control unit 300 of the control system 1 of this embodiment. The main process is a process for controlling the laser 30 and the galvanometer mirror 40 as actuators.
[0143] Reference Figure 10 , the laser control unit 300 determines whether a falling edge of the synchronous clock 50 has occurred (step S2). If a falling edge of the synchronous clock 50 has occurred ("yes" in step S2), the laser control unit 300 obtains a new distance command value and saves it as the latest value, and saves the latest value immediately before as the last value. More specifically, the laser control unit 300 copies the latest value of the currently saved distance command value to the last value (step S4), and saves the distance command value output by the main control unit 100 as the latest value (step S6). Then, the laser control unit 300 obtains the most recently measured interpolation clock number (step S8), and calculates the distance slope based on the latest value of the distance command value, the last value, and the interpolation clock number (step S10). In addition, the most recently measured interpolation clock number refers to the value stored in the interpolation clock number counter 319 at the time of step S8.
[0144] If the falling edge of the synchronous clock 50 has not occurred (No in step S2 ), the processing of steps S4 to S10 is skipped.
[0145] Next, the laser control unit 300 determines whether a rising edge of the synchronous clock 50 has occurred (step S12). If a rising edge of the synchronous clock 50 has occurred ("Yes" in step S12), a command (mirror control signal 540) for the irradiation position of the laser 30 is generated based on the latest value of the distance command value (step S14).
[0146] Furthermore, the laser control unit 300 sets the previous value of the distance command value as the initial value of the distance interpolation value (step S16 ), and sets the most recently calculated distance slope for interpolation processing (step S18 ).
[0147] If the rising edge of the synchronous clock 50 has not occurred (No in step S12 ), the processing of steps S16 and S18 is skipped.
[0148] Next, the laser control unit 300 determines whether a rising edge of the synchronous clock 50 has occurred (step S20). If a rising edge of the synchronous clock 50 has occurred ("Yes" in step S20), the laser control unit 300 adds the set distance slope to the current distance interpolation value to update the distance interpolation value (step S22). In other words, the laser control unit 300 sequentially adds the distance slope to the previous value of the distance command value at the specified timing indicated by the synchronous clock 50 to calculate the distance interpolation value.
[0149] Next, the laser control unit 300 determines whether the updated interpolated distance value has reached any target distance 316 (step S24). If the updated interpolated distance value has reached any target distance 316 ("Yes" in step S24), the laser control unit 300 outputs a command to execute a process (turning the laser 30 on or off) corresponding to the target distance 316 reached (step S26). Thus, when the interpolated distance value reaches the target distance 316, the laser control unit 300 outputs a command corresponding to the target distance 316. The process from step S2 onwards is then repeated.
[0150] If the updated distance interpolation value does not reach any target distance (No in step S24 ), the process of step S26 is skipped.
[0151] If the rising edge of the synchronous clock 50 has not occurred (No in step S20 ), the laser control unit 300 repeats the processing from step S2 onward.
[0152] Figure 11 1 is a flowchart showing the processing steps of measuring the interpolation clock number executed by the laser control unit 300 of the control system 1 of this embodiment. Figure 11 As shown, the laser control unit 300 measures the number of interpolation clocks 60 generated within one cycle of the synchronization clock 50 . Figure 11 The processing shown can be used with Figure 10 The main processing shown may be executed in parallel or may be executed integrally with the main processing.
[0153] Reference Figure 11 The laser control unit 300 determines whether a rising edge of the synchronization clock 50 has occurred (step S100). If a rising edge of the synchronization clock 50 has occurred ("Yes" in step S100), the laser control unit 300 resets the interpolation clock counter 319 (step S102) and starts outputting the interpolation clock 60 (step S104).
[0154] If the rising edge of the synchronous clock 50 has not occurred (No in step S100 ), the processing of steps S102 and S104 is skipped.
[0155] Laser control unit 300 determines whether a rising edge of interpolation clock 60 has occurred (step S106 ). If a rising edge of interpolation clock 60 has not occurred (“No” in step S106 ), the process from step S100 onwards is repeated.
[0156] When the rising edge of the interpolation clock 60 is generated (Yes in step S106 ), the laser control unit 300 increments the interpolation clock number counter 319 (step S108 ).
[0157] Then, the laser control unit 300 determines whether the value of the interpolated clock number counter 319 after incrementing has reached the interpolated clock set number (step S110). If the value of the interpolated clock number counter 319 after incrementing has reached the interpolated clock set number (Yes in step S110), the laser control unit 300 stops the output of the interpolated clock 60 (step S112). Thus, when the number of interpolated clocks 60 generated within one cycle of the synchronization clock 50 reaches a predetermined set value, the laser control unit 300 stops the output of the interpolated clock 60 until the next cycle of the synchronization clock 50 arrives. Then, the laser control unit 300 stands by until the rising edge of the synchronization clock 50 is generated (step S114). When the rising edge of the synchronization clock 50 is generated, the processes after step S102 are repeated.
[0158] If the value of the interpolated clock number counter 319 after incrementing has not reached the interpolated clock set number (No in step S110), the processes after step S100 are repeated.
[0159] Through the above processing, the irradiation timing of the laser 30 can be finely controlled.
[0160] <G. User Interface>
[0161] Next, an example of the user interface provided by the control system 1 of the present embodiment will be described. Typically, the user inputs settings for implementing the above-described processing via the operation display device 400 connected to the control device 10.
[0162] Figure 12 FIG. is a schematic diagram showing an example of the user interface screen 450 displayed on the operation display device 400 of the control system 1 of the present embodiment. Referring to Figure 12 , the user interface screen 450 accepts the settings required for the above-described processing.
[0163] The user interface screen 450 includes: an input unit 452 that accepts the setting of the cycle of the synchronization clock 50; a setting candidate list display unit 454; a check box 456; a display unit 458 that displays the cycle of the interpolated clock 60; a display unit 460 that displays the interpolation times; and a setting reflection button 462.
[0164] The user inputs the cycle of the synchronization clock 50 into the input unit 452. The operation display device
[0166] The user selects the check box 456 corresponding to the desired group in the group of the period and interpolation times of the interpolation clock 60 displayed in the candidate list display unit 454. The operation display device 400 displays the selected group of the period and interpolation times of the interpolation clock 60 on the display unit 458 and the display unit 460.
[0167] The user determines the period of the interpolation clock 60 in such a manner that the interpolation times become maximum within the set period of the synchronization clock 50, considering the trade-off between the tolerance for possible jitter in the synchronization clock 50 and the accuracy of the on / off control of the laser 30.
[0168] For example, when the period of the synchronization clock 50 is 50 [μs] (frequency is 20 [kHz]), the minimum period of the interpolation clock 60 becomes 50 [ns]. On the other hand, when the period of the synchronization clock 50 is 1 [ms] (frequency is 1 [kHz]), the minimum period of the interpolation clock 60 becomes 100 [ns].
[0169] Finally, when the user selects the setting reflection button 462, the displayed setting content is sent to the control device 10.
[0170] As described above, the user sets the period of the synchronization clock 50, the period of the interpolation clock 60, and the interpolation times, considering the tolerance for possible jitter in the synchronization clock 50 and the on / off control accuracy of the laser 30. In this way, the control device 10 provides a user interface for accepting the setting of the period of the synchronization clock 50 and the period of the interpolation clock 60.
[0171] <H. Modified Example>
[0172] In the above description, as the number of interpolation clocks 60 within one period of the synchronization clock 50 (interpolation clock number), an example of using the value obtained by actually measuring the interpolation clock 60 (measured value) is shown, but a predetermined fixed value (set value) may also be used. That is, the number of interpolation clocks 60 within one period of the synchronization clock 50 may also be a predetermined fixed value.
[0173] For example, if the period of the synchronization clock 50 is set to 50,000 [ns] and the period of the interpolation clock 60 is set to 100 [ns], the number of interpolation clocks 60 (interpolation clock number) within one period of the synchronization clock 50 can be set to 500.
[0174] In this way, by using a predetermined fixed value as the interpolation clock number, action verification can be performed more easily compared to the case of using the measured value.
[0175] <I. Supplementary Note>
[0176] The present embodiment described above includes the following technical ideas.
[0177] [Structure 1]
[0178] A control device (10) controls an actuator (30, 40), wherein the control device (10) comprises:
[0179] A storage unit (311) that obtains a new distance instruction value at a first timing indicated by a first clock (50) and stores it as a latest value, and stores the latest value immediately before as a previous value;
[0180] a second clock generating unit (318) for generating a second clock (60);
[0181] a first calculation unit (313) for calculating a distance slope based on the latest value and the previous value of the distance command value and the number of the second clocks within one cycle of the first clock;
[0182] a second calculation unit (314) for calculating a distance interpolation value by sequentially adding the distance slope and the previous value of the distance command value at a second timing indicated by the second clock;
[0183] a first instruction generating unit (315) which outputs a first instruction (530) corresponding to the target distance when the distance interpolation value reaches the target distance (316); and
[0184] A clock control unit (317) stops outputting the second clock until the next cycle of the first clock arrives when the number of the second clocks generated within one cycle of the first clock reaches a predetermined set value.
[0185] [Structure 2]
[0186] The control device according to Configuration 1 further includes a measuring unit configured to measure the number of the second clocks generated within one cycle of the first clock.
[0187] [Structure 3]
[0188] The control device according to Structure 1, wherein the number of the second clocks generated within one cycle of the first clock is a predetermined fixed value.
[0189] [Structure 4]
[0190] The control device according to any one of Structures 1 to 3, wherein a period of the first clock is set to an integral multiple of a period of the second clock.
[0191] [Structure 5]
[0192] The control device according to any one of Structures 1 to 4, wherein the clock control section starts generating the second clock at a third timing indicated by the first clock.
[0193] [Structure 6]
[0194] The control device according to any one of structures 1 to 5, wherein the control device further includes a second instruction generation unit (322) that generates a second instruction (540) for specifying a position according to the specified trajectory.
[0195] [Structure 7]
[0196] The control device according to any one of Structures 1 to 6, wherein the second command generation section outputs an instruction to open or close as the command.
[0197] [Structure 8]
[0198] The control device according to any one of Structures 1 to 7, wherein the control device provides a user interface (450) for accepting settings of the cycle of the first clock and the cycle of the second clock.
[0199] [Structure 9]
[0200] A control system includes actuators (30, 40) and a control device (10) for controlling the actuators.
[0201] The control device comprises:
[0202] A storage unit (311) that obtains a new distance instruction value at a first timing indicated by a first clock (50) and stores it as a latest value, and stores the latest value immediately before as a previous value;
[0203] a second clock generating unit (318) for generating a second clock (60);
[0204] a first calculation unit (313) for calculating a distance slope based on the latest value and the previous value of the distance command value and the number of the second clocks within one cycle of the first clock;
[0205] a second calculation unit (314) for calculating a distance interpolation value by sequentially adding the distance slope and the previous value of the distance command value at a second timing indicated by the second clock;
[0206] an instruction generating unit (315) which outputs an instruction (530) corresponding to the target distance when the distance interpolation value reaches the target distance (316); and
[0207] A clock control unit (317) that stops output of the second clock until the next cycle of the first clock arrives when the number of the second clocks generated within one cycle of the first clock reaches a preset value.
[0208] [Structure 10]
[0209] A control method, which is a control method for actuators (30, 40), and the control method includes the following steps:
[0210] Steps (S4, S6) of obtaining a new distance command value at a first timing indicated by a first clock (50), saving it as the latest value, and saving the immediately preceding latest value as the previous value;
[0211] Step (S10) of calculating a distance slope based on the latest value and the previous value of the distance command value, and the number of second clocks within one cycle of the first clock;
[0212] Step (S22) of successively adding the distance slope and the previous value of the distance command value at a second timing indicated by the second clock to calculate a distance interpolation value;
[0213] Steps (S24, S26) of outputting a command corresponding to the target distance when the distance interpolation value reaches the target distance; and
[0214] Step (S112) of stopping output of the second clock until the next cycle of the first clock arrives when the number of the second clocks generated within one cycle of the first clock reaches a preset value.
[0215] <J. Advantages>
[0216] According to the control system 1 of the present embodiment, by interpolating the distance command value updated at the cycle of the synchronous clock with a cycle shorter than the synchronous clock, it is possible to judge whether the target distance is reached with higher accuracy. In addition, by adopting an algorithm that does not affect the number of interpolation clocks generated within the synchronous clock even if jitter occurs in the synchronous clock, it is possible to prevent the calculated distance interpolation value from being affected by the jitter. Thus, it is possible to stably execute more precise control.
[0217] The disclosed embodiment should be considered illustrative in all aspects and not restrictive. The scope of the present invention is represented not by the above description but by the claims, and is intended to include meanings equivalent to the claims and all modifications within the scope.
[0218] Reference Numeral Explanation
[0219] 1: Control system; 4: Workpiece; 10: Control device; 20: XY table; 22: Plate; 24: Servo motor; 26: Servo drive; 28: Encoder; 30: Laser; 40: Galvanometer mirror; 42: X-axis scanning motor; 43: Axis scanning mirror; 44: Y-axis scanning motor; 45: Y-axis scanning mirror; 46: Z-axis scanning motor; 47: Lens; 50: Synchronous clock; 51, 52, 53: Control line; 54: Communication line; 60 : interpolation clock; 100: main control unit; 102: processor; 104: main memory; 106: storage; 108: system program; 110: application program; 112: bus controller; 114: internal bus; 130: trajectory generation unit; 132: distance command calculation unit; 134: passing point sequence; 200: workbench control unit; 210: workbench control operation unit; 220: clock generation unit; 230: servo interface circuit; 300: Laser control unit; 310: Laser / reflector control calculation unit; 311: Register; 311A: Latest value area; 311B: Previous value area; 312: Distance difference calculation unit; 313: Distance slope calculation unit; 314: Distance interpolation unit; 315: Comparison unit; 316: Target distance; 317: Interpolation clock control unit; 318: Interpolation clock generation unit; 319: Interpolation clock count counter; 322: Position command generation unit; 330 : Output interface circuit; 340: Communication interface circuit; 350, 352, 354: Distance instruction value; 400: Operation display device; 450: User interface screen; 452: Input unit; 454: Setting candidate list display unit; 456: Check box; 458, 460: Display unit; 462: Setting reflection button; 510: Servo instruction signal; 520: Encoder output information; 530: Laser control signal; 540: Reflector control signal.
Claims
1. A control device for controlling an actuator, wherein: The control device comprises: a storage unit that acquires a new distance command value at a first timing indicated by a first clock and stores it as a latest value, and stores the latest value immediately before as a previous value; A second clock generating unit, which generates a second clock; a first calculation unit that calculates a distance slope based on the latest value and the previous value of the distance command value and the number of the second clocks in one cycle of the first clock; a second calculation unit that calculates a distance interpolation value by sequentially adding the distance slope to the previous value of the distance command value at a second timing indicated by the second clock; a first instruction generating unit, which outputs a first instruction corresponding to the target distance when the distance interpolation value reaches the target distance; as well as The clock control unit stops outputting the second clock until the next cycle of the first clock arrives when the number of the second clocks generated within one cycle of the first clock reaches a predetermined set value.
2. The control device according to claim 1, wherein: The control device further includes a measuring unit configured to measure the number of the second clocks generated in one cycle of the first clock.
3. The control device according to claim 1 or 2, wherein: The number of the second clocks generated within one cycle of the first clock is a predetermined fixed value.
4. The control device according to any one of claims 1 to 3, wherein: The period of the first clock is set to be an integral multiple of the period of the second clock.
5. The control device according to any one of claims 1 to 4, wherein: The clock control section starts generating the second clock at a third timing indicated by the first clock.
6. The control device according to any one of claims 1 to 5, wherein: The control device further includes a second command generating unit configured to generate a second command for designating a position according to the designated trajectory.
7. The control device according to any one of claims 1 to 6, wherein: The first command generating unit outputs an instruction to open or close as a command.
8. The control device according to any one of claims 1 to 7, wherein: The control device provides a user interface for accepting settings of the cycle of the first clock and the cycle of the second clock.
9. A control system comprising an actuator and a control device for controlling the actuator, The control device comprises: a storage unit that acquires a new distance command value at a first timing indicated by a first clock and stores it as a latest value, and stores the latest value immediately before as a previous value; A second clock generating unit, which generates a second clock; a first calculation unit that calculates a distance slope based on the latest value and the previous value of the distance command value and the number of the second clocks in one cycle of the first clock; a second calculation unit that calculates a distance interpolation value by sequentially adding the distance slope to the previous value of the distance command value at a second timing indicated by the second clock; an instruction generating unit, which outputs an instruction corresponding to the target distance when the distance interpolation value reaches the target distance; as well as The clock control unit stops outputting the second clock until the next cycle of the first clock arrives when the number of the second clocks generated within one cycle of the first clock reaches a predetermined set value.
10. A control method, which is a control method for an actuator, wherein: The control method comprises the following steps: At a first timing indicated by a first clock, a new distance command value is acquired and stored as a latest value, and the latest value immediately before is stored as a previous value; calculating a distance slope based on the latest value and the previous value of the distance command value and the number of second clocks within one cycle of the first clock; At a second timing indicated by the second clock, the distance slope and the previous value of the distance command value are sequentially added to calculate a distance interpolation value; When the distance interpolation value reaches the target distance, outputting an instruction corresponding to the target distance; and When the number of the second clocks generated within one cycle of the first clock reaches a predetermined set value, the output of the second clock is stopped until the next cycle of the first clock arrives.
