Servo motor control device
By generating target position and reaction force instructions that vary by time in the servo motor control device and selecting appropriate driving signals, the problem that the position and force of the driven body in the prior art is difficult to accurately control, and higher control is achieved Accuracy and machining efficiency.
Patent Information
- Application Number
- CN202010223187.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2019-03-28
- Filing Date
- 2020-03-26
- Publication Date
- 2024-11-22
- Estimated Expiration
- 2040-03-26
AI Technical Summary
The existing servo motor control device is difficult to accurately control the position and force of the driven body when applying force from the outside, especially in the case of speed override control, and there is a risk of position or force deviation.
The position command production unit and the reaction force command production unit respectively generate target position and target reaction force command that vary according to time, and generate driving signals through the position reference driving control unit and the reaction force reference driving control unit to position the driven body When the reaction force is close to the target value, the selection drive signal selection unit selects the position reference driving signal or the reaction reference driving signal to suppress deviation.
Accurate control of the position and reaction force of the driven body is achieved, reducing the risk of position and force deviation under the speed exceeding control, and improving processing quality.
Smart Images

Figure CN111756309B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to a servo motor control device. Background Art
[0002] For example, it is sometimes desirable to accurately control the position and pressure (reaction force applied to the driven body) of a driven body such as a die in a stamping process at each time. For example, slight differences in conditions such as deviations of workpieces may cause the pressure applied to the driven body to vary greatly. Therefore, a technology has been proposed that uses a servo motor capable of detailed feedback control to drive the driven body and control the position and force of the driven body.
[0003] As an example, Patent Document 1 describes “a control device for a servo motor, comprising: a force detection unit for detecting a force applied to a driven body driven by the servo motor from the outside; a position instruction generating unit for generating a position instruction for indicating the position of the driven body; a position detection unit for detecting the position of the driven body; a force instruction generating unit for generating a force instruction for indicating the force to be applied to the driven body; a position control processing unit for generating a motor motion instruction based on a position deviation calculated from the position instruction generated by the position instruction generating unit and the position detected by the position detection unit; a force control processing unit for generating a motor motion instruction based on a force deviation calculated from the force instruction generated by the force instruction generating unit and the force detected by the force detection unit; and a control mode selecting unit for generating a motor motion instruction generated by the position control processing unit. The control device of the servo motor selectively switches between position control for controlling the movement of the servo motor according to the motor movement instruction of the position control processing unit and force control for controlling the movement of the servo motor according to the motor movement instruction of the force control processing unit by comparing the command with the motor movement instruction produced by the force control processing unit, wherein when a force is applied to the driven body from the outside, the control device of the servo motor controls the movement of the servo motor so that the driven body is subjected to a predetermined force, and the control device of the servo motor is characterized in that it also has a command correction unit, which corrects the force command produced by the force command production unit or the position command produced by the position command production unit and sends it to the force control processing unit or the position control processing unit to change the timing of the control mode selection unit switching between position control and force control.
[0004] Patent Document 1: Japanese Patent Application Publication No. 2006-130533 Summary of the invention
[0005] Problem that the invention aims to solve
[0006] Regarding the control device described in Patent Document 1, the control is performed so that the force becomes a desired value when a force is applied to the driven body from the outside, and the control is performed so that the position becomes a desired value when a force is not applied to the driven body from the outside, and the position of the driven body is not controlled when a force is applied to the driven body from the outside. Specifically, in the technology described in Patent Document 1, the driving is performed so that the force of the driven body is consistent with the command value, thereby there is a possibility that the moving speed of the driven body becomes too large. In particular, when the speed is overridden in order to improve the processing efficiency, the risk of the position or force of the driven body deviating from the appropriate value becomes greater.
[0007] Therefore, a servo motor control device that can accurately control the position of a driven body and the reaction force received by the driven body is desired.
[0008] Solutions for solving problems
[0009] A servo motor control device according to one embodiment of the present disclosure includes: a position command generating unit that generates a position command for determining a target position that a driven body driven by a servo motor should be at over time; a reaction force command generating unit that generates a reaction force command for determining a target reaction force that the driven body should receive by driving the servo motor over time; a position acquisition unit that acquires an actual position of the driven body; a position reference drive control unit that generates a position reference drive signal for driving the servo motor so that the position acquired by the position acquisition unit approaches the target position; a reaction force acquisition unit that acquires a reaction force actually received by the driven body; a reaction force reference drive control unit that generates a reaction force reference drive signal for driving the servo motor so that the reaction force acquired by the reaction force acquisition unit approaches the target reaction force; and a drive signal selection unit that selects one of the position reference drive signal and the reaction force reference drive signal, wherein the position command generating unit generates the position command so that the target position has a quadratic or higher relationship with respect to time, and the reaction force command generating unit generates the reaction force command so that the relationship between the target reaction force and the target position becomes substantially linear.
[0010] Effects of the Invention
[0011] According to the present disclosure, it is possible to provide a servo motor control device that can accurately control the position of a driven body and the reaction force received by the driven body. BRIEF DESCRIPTION OF THE DRAWINGS
[0012] Figure 1This is a block diagram showing the configuration of a machine tool including a servo motor control device according to an embodiment of the present disclosure.
[0013] Figure 2 It is shown in Figure 1 A diagram showing the position and reaction force commands generated by a servo motor control device.
[0014] Figure 3 It is shown Figure 1 A block diagram of control of position commands and reaction force commands in a servo motor control device.
[0015] Figure 4 It is shown in Figure 1 A diagram showing alternatives for position commands and reaction force commands produced in a servo motor control device.
[0016] Figure 5 It is shown Figure 1 Flowchart of the control process in the servo motor control device.
[0017] Description of Reference Numerals
[0018] 1: servo motor control device; 10: basic information acquisition unit; 20: position instruction generation unit; 30: reaction force instruction generation unit; 40: position acquisition unit; 50: position reference drive control unit; 60: reaction force acquisition unit; 70: reaction force reference drive control unit; 80: drive signal selection unit; M: servo motor; W: driven body. DETAILED DESCRIPTION
[0019] Hereinafter, embodiments of the present disclosure will be described with reference to the drawings. Figure 1 1 is a block diagram showing a configuration of a machine tool 100 including a configuration of a servo motor control device 1 according to an embodiment of the present disclosure.
[0020] Figure 1 The machine tool 100 includes a driven body (e.g., a stamping type) W, a servo motor M that drives the driven body W, a servo driver S that supplies a driving current to the servo motor M, and a servo motor control device 1 that inputs an action instruction to the servo driver S, and has a position detection unit P that detects the position of the driven body W as the rotational position of the servo motor M and a reaction force detection unit F that detects the reaction force received by the driven body W from the outside.
[0021] The servo motor control device 1 includes: a basic information acquisition unit 10, which acquires the initial position and initial reaction force of a driven body W driven by a servo motor M and the arrival position and arrival reaction force; a position instruction generation unit 20, which generates a position instruction for determining the target position that the driven body W should be at in time; a reaction force instruction generation unit 30, which generates a reaction force instruction for determining the target reaction force that the driven body W should receive through the drive of the servo motor M in time; a position acquisition unit 40, which acquires the actual position of the driven body W; a position reference drive control unit 50, which generates a position reference drive signal for driving the servo motor M so that the position acquired by the position acquisition unit 40 approaches the target position; a reaction force acquisition unit 60, which acquires the reaction force actually received by the driven body W; a reaction force reference drive control unit 70, which generates a reaction force reference drive signal for driving the servo motor M so that the reaction force acquired by the reaction force acquisition unit 60 approaches the target reaction force; and a drive signal selection unit 80, which selects any one of the position reference drive signal and the reaction force reference drive signal.
[0022] The servo motor control device 1 can be configured by installing an appropriate program in a computer device having a CPU, a memory, etc. The basic information acquisition unit 10, the position instruction generation unit 20, the reaction force instruction generation unit 30, the position acquisition unit 40, the position reference drive control unit 50, the reaction force acquisition unit 60, the reaction force reference drive control unit 70, and the drive signal selection unit 80 of the servo motor control device 1 are functionally distinguished, and may not be clearly distinguished in terms of physical structure and program structure.
[0023] The basic information acquisition unit 10 can be configured to analyze a machining program and acquire the initial position and initial reaction force (the position and reaction force of the arrival position and arrival pressure of the previous instruction) and the arrival position and arrival reaction force of the driven body W in each instruction of the machining program.
[0024] The position command generating unit 20 generates a position command such that the target position of the driven body W at each time has a quadratic or higher relationship with respect to time based on the initial position and the arrival position of the driven body W acquired by the basic information acquiring unit 10 and the parameters specified in the machining program or pre-stored in the servo motor control device 1. That is, the position command generating unit 20 can be configured to calculate the target position x as a quadratic or higher time function x(t)=A n ·t n +A n-1 ·t n-1 +···+A0·t 0 In addition, n is an integer greater than 2, A n is the coefficient of each time.
[0025] As a specific example, Figure 2 As shown, the position command generating unit 20 can be configured to generate a time function x(t)=A2·t so that the target position is a quadratic time function x(t)=A2·t 2 +A1·t+A0 is a position instruction that changes with time. In this case, the position instruction can have a first position change time Q1, a second position change time Q2 located after the first position change time Q1, and a third position change time Q3 located after the second position change time Q2, wherein, in the first position change time Q1, the initial target position is set to a value equal to the initial position, and the second-order differential value (acceleration) of the target position is fixed, in the second position change time Q2, the first-order differential value (speed) of the target position is fixed (A2=0), in the third position change time Q3, the second-order differential value of the target position is set to a value opposite to the second-order differential value of the first position change time Q1, and the final target position is set to a value equal to the arrival position. In addition, Figure 2 The portion indicated by the middle dotted line indicates a state in which the command value is maintained between the preceding process and the succeeding process.
[0026] The second and first order differential values of the target position in the position command have appropriate values depending on the device configuration of the machine tool 100 , the object to be processed, etc. Therefore, these values are preferably set to values specified in the processing program or values pre-stored in the servo motor control device 1 .
[0027] The reaction force instruction generating unit 30 generates the reaction force instruction in such a manner that the relationship between the target reaction force and the target position is substantially linear. Figure 3 As shown, the correlation coefficient between the time to reach the target position and the time to reach the target reaction force is preferably greater than the ratio of the gain of the position reference drive control unit 50 to the gain of the reaction force reference drive control unit 70. By setting the correlation coefficient between the position command and the reaction force command to be greater than the ratio, the deviation between the reaction force and the target reaction force when the servo motor M is driven by the position reference drive signal, and the deviation between the position and the target position when the servo motor M is driven by the reaction force reference drive signal can be suppressed. In this way, both the stamping pressure and the stamping speed in the machine tool 100 can be maintained within an appropriate range, thereby improving the processing quality. The lower limit of the specific numerical value of the correlation coefficient between the position command and the reaction force command is preferably 0.90, and more preferably 0.95.
[0028] Therefore, similar to the position instruction generating unit 20, the reaction force instruction generating unit 30 generates a reaction force instruction such that the target reaction force of the driven body W at each time has a quadratic or higher relationship with respect to time based on the initial reaction force and the arrival reaction force of the driven body W acquired by the basic information acquiring unit 10 and the parameters specified in the machining program or pre-stored in the servo motor control device 1. That is, the reaction force instruction generating unit 30 can be configured to calculate the target reaction force y as a time function y(t)=B having the same degree as the time function x(t) of the target position x. n ·t n +B n-1 ·t n-1 +···+B0·t 0 .
[0029] As a specific example, Figure 2 As shown in FIG. 1 , the reaction force command generating unit 30 can be configured to generate a target reaction force having a quadratic time function y(t)=B2·t 2 +B1·t+B0 is a reaction force instruction that changes with time. In this case, the reaction force instruction Sy can have a first reaction force change time R1, a second reaction force change time R2 located after the first reaction force change time R1, and a third reaction force change time R3 located after the second reaction force change time R2, wherein, in the first reaction force change time R1, the initial target reaction force is set to a value equal to the initial reaction force, and the second-order differential value (acceleration) of the target reaction force is fixed, in the second reaction force change time R2, the first-order differential value (speed) of the target reaction force is fixed (B2=0), in the third reaction force change time R3, the second-order differential value of the target reaction force is set to a value opposite to the second-order differential value of the first reaction force change time R1, and the final target reaction force is set to a value equal to the arrival reaction force.
[0030] Preferably, the first reaction force change time R1, the second reaction force change time R2 and the third reaction force change time R3 in the reaction force instruction are substantially equal to the first position change time Q1, the second position change time Q2 and the third position change time Q3 in the position instruction, and particularly preferably, the second reaction force change time R2 in the reaction force instruction is substantially equal to the second position change time Q2 in the position instruction. Thus, the relationship between the target reaction force and the target position can be substantially linear.
[0031] The lower limit of the ratio of the second reaction force change time R2 to the second position change time Q2 is preferably 0.95, and more preferably 0.98. On the other hand, the upper limit of the ratio of the second reaction force change time R2 to the second position change time Q2 is preferably 1.05, and more preferably 1.02. By setting the ratio of the second reaction force change time R2 to the second position change time Q2 to be above the lower limit and below the upper limit, the relationship between the position command and the pressure command can be made substantially linear, thereby suppressing the deviation of the actual position and reaction force relative to the target position and target reaction force.
[0032] In addition, if Figure 4 As shown, the reaction force instruction preparation unit 30 may also prepare a reaction force instruction such that the target reaction force in the reaction force instruction reaches the arrival reaction force and becomes a fixed value before the target position in the position instruction reaches the arrival position. In other words, the reaction force instruction preparation unit 30 may make the first reaction force change time R1 and the third reaction force change time R3 in the reaction force instruction slightly shorter than the first position change time Q1 and the third position change time Q3 in the position instruction. Therefore, the reaction force instruction may also have a reaction force holding time R4 for keeping the target reaction force at the arrival reaction force after the third reaction force change time R3, so that the overall time length is consistent with the overall time length of the position instruction.
[0033] In order to generate such a reaction force instruction, the values of the first reaction force change time R1 and the third reaction force change time R3, or the ratio of the first reaction force change time R1 and the third reaction force change time R3 to the first position change time Q1 and the third position change time Q3 may be described in the machining program. In this case, the instruction of the machining program may include a code number indicating that the instruction of the present embodiment is applied, an arrival position, a speed in the second reaction force change time R2, an arrival reaction force, and the length of the first reaction force change time R1.
[0034] In addition, the reaction force instruction generating unit 30 may also make the second reaction force change time R2 in the reaction force instruction slightly shorter than the second position change time Q2 in the position instruction, thereby generating a reaction force instruction such that the target reaction force in the reaction force instruction reaches the arrival reaction force before the target position in the position instruction reaches the arrival position and becomes a fixed value. In this case, the value of the second reaction force change time R2 or the ratio of the second reaction force change time R2 to the second position change time Q2 may be described in the machining program.
[0035] The response of the feedback control of the reaction force of the driven body W is slower than the feedback control of the position of the driven body W. Therefore, by making the target reaction force in the reaction force instruction reach the target reaction force before the target position in the position instruction, the response delay of the reaction force control is compensated, so that the actual position of the driven body W and the actual reaction force can be made closer to linearity, thereby further reducing the deviation of the actual position and reaction force from the target position and target reaction force.
[0036] The position acquisition unit 40 acquires a detection value of the position detection unit P. The position detection unit P can be, for example, a rotary encoder provided in the servo motor M or the like.
[0037] The position reference drive control unit 50 generates a position reference drive signal for specifying the output, such as speed and torque, of the servo motor M based on the deviation between the current target position in the position command and the actual position of the driven body W acquired by the position acquisition unit 40. That is, the position reference drive control unit 50 performs feedback control to change the value of the position reference drive signal so that the position of the driven body W approaches the target position.
[0038] The reaction force acquisition unit 60 acquires the detection value of the reaction force detection unit F. In addition, the reaction force detection unit F can be configured to have a strain gauge or the like, for example.
[0039] The reaction force reference drive control unit 70 generates a reaction force reference drive signal for specifying the output, such as speed and torque, of the servo motor M based on the deviation between the current target reaction force in the reaction force instruction and the actual reaction force of the driven body W acquired by the reaction force acquisition unit 60. That is, the reaction force reference drive control unit 70 performs feedback control to change the value of the reaction force reference drive signal so that the reaction force of the driven body W approaches the target reaction force.
[0040] The drive signal selection unit 80 considers the value of the position reference drive signal and the value of the reaction force reference drive signal, selects one of the position reference drive signal and the reaction force reference drive signal, and inputs it to the servo driver S. Specifically, the drive signal selection unit 80 can be configured to input the smaller value of the position reference drive signal and the reaction force reference drive signal to the servo driver S. In addition, the drive signal selection unit 80 can also refer to the past values of the position reference drive signal and the reaction force reference drive signal, or other information in addition to these information, to determine which one of the position reference drive signal and the reaction force reference drive signal to select.
[0041] Figure 5The control process of one process of the machine tool 100 in the servo motor control device 1 is shown. The servo motor control device 1 has the following processes: acquiring basic information including the initial position and initial reaction force of the driven body W, and the arrival position and arrival reaction force (step S11: basic information acquisition process); making a position instruction for determining the target position of the driven body W according to time (step S12: position instruction preparation process); making a reaction force instruction for determining the target reaction force to be received by the driven body W according to time (step S13: reaction force instruction preparation process); acquiring the actual position of the driven body W (step S14: position acquisition process); generating a position reference drive signal for driving the servo motor M so that the actual position of the driven body W approaches the target position (step S15: position reference drive signal generation process). The process comprises the following steps: obtaining the reaction force actually exerted on the driven body W (step S16: reaction force detection process); generating a reaction force reference drive signal for driving the servo motor M so that the actual reaction force of the driven body W is close to the target reaction force (step S17: reaction force reference drive signal generation process); comparing the position reference drive signal with the reaction force reference drive signal (step S18: drive signal comparison process); outputting the position reference drive signal to the servo driver S (step S19: position reference drive signal output process); outputting the reaction force reference drive signal to the servo driver S (step S20: reaction force reference drive signal output process); and confirming whether the process of applying this control has been completed (step S21: completion confirmation process).
[0042] In the basic information acquisition process of step S11 , the basic information acquisition unit 10 acquires the initial position, initial reaction force, arrival position and arrival reaction force of the driven body W, and information necessary for generating a position command and a reaction force command.
[0043] In the position command generating step of step S12 , the position command generating unit 20 generates a position command for changing the target position over time based on the information acquired in the basic information acquiring step.
[0044] In the reaction force command preparation step of step S13 , the reaction force command preparation unit 30 prepares a reaction force command for changing the target reaction force with time so as to have a substantially linear relationship with the target position based on the information acquired in the basic information acquisition step.
[0045] In the position acquisition process of step S14 , the current position of the driven object W is confirmed by the position acquisition unit 40 .
[0046] In the position reference drive signal generating process of step S15, the position reference drive control unit 50 generates a position reference drive signal for driving the servo motor M so as to reduce the deviation between the current target position in the position command generated in the position command generating process and the position of the driven body W confirmed in the position acquiring process.
[0047] In the reaction force detection process of step S16 , the current reaction force acting on the driven object W is confirmed by the reaction force acquisition unit 60 .
[0048] In the reaction force reference drive signal generation process of step S17, the reaction force reference drive control unit 70 generates a reaction force reference drive signal for driving the servo motor M so as to reduce the deviation between the current target reaction force in the reaction force instruction generated by the reaction force instruction generation process and the reaction force of the driven body W confirmed by the position acquisition process.
[0049] In the drive signal comparison process of step S18, it is confirmed whether the value of the position reference drive signal generated by the position reference drive signal generation process is less than the value of the reaction force reference drive signal generated by the reaction force reference drive signal generation process. In this drive signal comparison process, if the position reference drive signal is less than the reaction force reference drive signal, the process proceeds to the position reference drive signal output process of step S19, and if the position reference drive signal exceeds the reaction force reference drive signal, the process proceeds to the reaction force reference drive signal output process of step S20.
[0050] In the position reference drive signal output process of step S19, the position reference drive signal generated by the position reference drive signal generation process is output. On the other hand, in the reaction force reference drive signal output process of step S20, the reaction force reference drive signal generated by the reaction force reference drive signal generation process is output. That is, in steps S18 to S20, the smaller one of the position reference drive signal and the reaction force reference drive signal is selected and output to the servo driver S.
[0051] In the end confirmation process of step S21, it is confirmed whether the process to which this control is applied has been completed, that is, whether the time of the position command and the reaction force command has reached the end. If the process to which this control is applied has not been completed, that is, if there is a target position that has not been used in the position reference drive signal generation process and a target reaction force that has not been used in the reaction force reference drive signal generation process, the process returns to step S14 and the subsequent processes are repeated.
[0052] As described above, the servo motor control device 1 generates a position command in the position command generating unit 20 that has a quadratic or higher relationship with respect to time, and generates a reaction force command in the reaction force command generating unit 30 that has a substantially linear relationship with the position command. Thus, the servo motor control device 1 can suppress the difference between the actual reaction force acting on the driven body W and the target reaction force in the reaction force command from becoming larger when the position reference drive control unit 50 is used to perform feedback control so that the actual position of the driven body W approaches the target position in the position command. In addition, the servo motor control device 1 can also suppress the difference between the actual position of the driven body W and the target position in the position command from becoming larger when the reaction force reference drive control unit 70 is used to perform feedback control so that the reaction force acting on the driven body W approaches the target reaction force in the reaction force command. This effect is particularly significant when an overrunning control is performed to increase the motion speed of the machine tool 100.
[0053] The above is a description of the embodiments of the servo motor control device involved in the present disclosure, but the servo motor control device involved in the present disclosure is not limited to the above embodiments. In addition, the effects described in the embodiments are only the best effects produced by the present disclosure, and the effects obtained by the servo motor control device involved in the present disclosure are not limited to the effects described in the embodiments.
[0054] In the servo motor control device involved in the present disclosure, the position command and the reaction force command may be calculated as any function such as an exponential function or a trigonometric function, or may be calculated by connecting a plurality of linear functions, or may be calculated by referring to any reference waveform.
Claims
1. A servo motor control device, comprising: a position instruction generating unit for generating a position instruction for determining a target position of a driven body driven by the servo motor according to time; a reaction force instruction generating unit for generating a reaction force instruction for determining, in time, a target reaction force to be applied to the driven body by driving the servo motor; a position acquisition unit for acquiring an actual position of the driven object; a position reference drive control unit that generates a position reference drive signal for driving the servo motor so that the position acquired by the position acquisition unit approaches the target position; a reaction force acquisition unit, which acquires the reaction force actually exerted on the driven body; a reaction force reference drive control unit that generates a reaction force reference drive signal for driving the servo motor so that the reaction force acquired by the reaction force acquisition unit approaches the target reaction force; as well as a drive signal selection unit that selects one of the position reference drive signal and the reaction force reference drive signal, wherein the position instruction generating unit generates the position instruction in such a way that the target position becomes a time function of quadratic or higher. The reaction force command generating unit generates the reaction force command so that the relationship between the target reaction force and the target position becomes substantially linear.
2. The servo motor control device according to claim 1, wherein: The correlation coefficient between the time to reach the target position and the time to reach the target reaction force is equal to or greater than the ratio of the gain of the position reference drive control unit to the gain of the reaction force reference drive control unit.
3. The servo motor control device according to claim 1 or 2, wherein: The position instruction generating unit calculates the target position as a time function of quadratic or higher order. The reaction force command generating unit calculates the target reaction force as a time function having the same order as that of the time function of the target position.
4. The servo motor control device according to claim 1 or 2, wherein: The reaction force command generating unit generates the reaction force command such that the target reaction force becomes a fixed value before the target position in the position command.
5. The servo motor control device according to claim 1 or 2, wherein: The device further comprises a basic information acquisition unit for acquiring an initial position and an initial reaction force, and an arrival position and an arrival reaction force of the driven body. The position instruction generating unit generates the position instruction for changing the target position with time in a manner having a first position change time, a second position change time located after the first position change time, and a third position change time located after the second position change time, wherein at the first position change time, the initial target position is set to a value equal to the initial position and the second-order differential value of the target position is fixed, at the second position change time, the first-order differential value of the target position is fixed, at the third position change time, the second-order differential value of the target position is set to a value opposite in sign to the second-order differential value of the first position change time, and the final target position is set to a value equal to the arrival position, The reaction force instruction production unit produces the reaction force instruction that changes the target reaction force over time in a manner having a first reaction force change time, a second reaction force change time located after the first reaction force change time, and a third reaction force change time located after the second reaction force change time, wherein, at the first reaction force change time, the initial target reaction force is set to a value equal to the initial reaction force, and the second-order differential value of the target reaction force is fixed, at the second reaction force change time, the first-order differential value of the target reaction force is fixed, and the length of the second reaction force change time is approximately equal to the length of the second position change time, at the third reaction force change time, the second-order differential value of the target reaction force is set to a value that is opposite in sign to the second-order differential value of the first reaction force change time, and the final target reaction force is set to a value equal to the arrival reaction force.
6. The servo motor control device according to claim 5, wherein: The reaction force command generating unit sets the first reaction force change time or the second reaction force change time to a time designated by a program.
