Control device

Through the back electromotive force and feedback signal generated by rotating the output shaft with external force, the control information of the three-phase AC motor is estimated, which solves the problem of complex confirmation of the control information of the three-phase AC motor in the servo system, and improves control efficiency and accuracy.

CN118947057APending Publication Date: 2024-11-12OMRON CORP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202380029985.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2022-04-01
Filing Date
2023-03-06
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

In the servo system, the control information of setting up a three-phase AC motor is complex, especially the arrangement order of the three-phase coils and the confirmation process of the encoder information are cumbersome, which affects the setting and control efficiency of the servo driver.

Method used

By utilizing external force to rotate the output shaft, control information of the three-phase AC motor is estimated and controlled based on this information, simplifying the setting of the servo driver and the correction of the motor's electrical angle.

Benefits of technology

This enables a simpler method to obtain control information of the three-phase AC motor, improves the control efficiency and accuracy of the servo system, and reduces the complexity of the manual confirmation and setting process.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118947057A_ABST
    Figure CN118947057A_ABST
Patent Text Reader

Abstract

Information relating to control of a three-phase AC motor is acquired by a simpler method. This control device controls a three-phase AC motor having an encoder that outputs a feedback signal indicating the rotation state of an output shaft, and a U-phase coil, a V-phase coil, and a W-phase coil, and is provided with: a first acquisition unit that acquires a feedback signal; a counter electromotive force acquisition unit that acquires information relating to a counter electromotive force generated in the U-phase coil, the V-phase coil, and the W-phase coil by rotating the output shaft in a desired direction by an external force; a second acquisition unit that acquires, from the encoder, a feedback signal including information relating to the rotation of the output shaft rotated by the external force; and a control unit that estimates information pertaining to control of the three-phase AC motor on the basis of the information pertaining to the back electromotive force and the feedback signal, and controls the three-phase AC motor using the estimated information pertaining to control of the three-phase AC motor.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to a control device. Background Art

[0002] Conventionally, a motor having a servo driver for receiving a feedback signal from the motor to perform servo control and an encoder for detecting the rotation state of the motor shaft is used (for example, refer to Patent Documents 1 to 3).

[0003] Prior art literature

[0004] Patent Literature

[0005] Patent Document 1: Japanese Patent Application Publication No. 2018-061327

[0006] Patent Document 2: Japanese Patent Application Publication No. 2018-191422

[0007] Patent Document 3: Japanese Patent Application Publication No. 2010-057302 Summary of the invention

[0008] Problems to be solved by the invention

[0009] In the servo system, the servo driver is set with information related to motor control, such as the arrangement order of the three-phase coils configured in the corresponding three-phase AC motor and the information of the encoder possessed by the three-phase AC motor. The servo driver controls the three-phase AC motor using the set information related to motor control. The information related to motor control varies for each model of the three-phase AC motor, so it is troublesome to manually confirm the information related to motor control before using the servo system, which causes trouble in setting the servo driver.

[0010] One aspect of the technology disclosed herein aims to provide a control device capable of acquiring information related to control of a three-phase AC motor by a simpler method.

[0011] Means for solving problems

[0012] One aspect of the technology disclosed in the present invention is illustrated by the following control device. The present control device is a control device for controlling a three-phase AC motor having an encoder that outputs a feedback signal indicating the rotation state of an output shaft, and a U-phase coil, a V-phase coil, and a W-phase coil. The present control device comprises: a first acquisition unit that acquires information related to the back electromotive force generated in the U-phase coil, the V-phase coil, and the W-phase coil when the output shaft is rotated in a desired direction by an external force; a second acquisition unit that acquires the feedback signal containing information related to the rotation of the output shaft rotated by the external force from the encoder; and a control unit that estimates information related to the control of the three-phase AC motor based on the information related to the back electromotive force and the feedback signal, and uses the estimated information related to the control of the three-phase AC motor to control the three-phase AC motor.

[0013] When the output shaft is rotated in a desired direction by an external force, a back electromotive force is generated in the U-phase coil, the V-phase coil, and the W-phase coil, and a current based on the back electromotive force flows to the control device. In addition, when the output shaft is rotated in a desired direction by an external force, a feedback signal indicating the rotation is output to the control device. The control device can estimate information related to the control of the three-phase AC motor based on information related to the back electromotive force generated in the U-phase coil, the V-phase coil, and the W-phase coil and the feedback signal, and use the estimated information related to the control of the three-phase AC motor to control the three-phase AC motor. That is, the control device can set information related to the motor by a simple operation such as using an external force to rotate the output shaft in a desired direction.

[0014] The control device may also have the following features. The control unit estimates the arrangement order of the U-phase coil, the V-phase coil, and the W-phase coil based on the information related to the back electromotive force, and uses the estimated arrangement order of the U-phase coil, the V-phase coil, and the W-phase coil to control the three-phase AC motor. The control device having such features can drive the three-phase AC motor by supplying current to the U-phase coil, the V-phase coil, and the W-phase coil using the estimated arrangement order.

[0015] The control device may also have the following features. The information related to the back electromotive force includes a first correspondence between the voltage and the electrical angle between any two phases of the U phase, the V phase, and the W phase. The control unit obtains the positive and negative ratio of the change in the voltage between the two phases when the voltage between the two phases is 0 in the first correspondence and the first electrical angle when the voltage between the two phases is 0. Based on the second correspondence between the voltage and the electrical angle of each of the U phase, the V phase, and the W phase pre-stored in the storage unit, the positive and negative ratio of the change in the voltage and the first electrical angle, and the estimated arrangement order of the U phase coil, the V phase coil, and the W phase coil, the bias for correcting the deviation between the electrical angle of the three-phase AC motor and the origin of the encoder is determined, and the three-phase AC motor is controlled using the determined bias. By having such a feature, the control device can correct the deviation and control the three-phase AC motor even if there is a deviation between the origin of the encoder and the 0 degree electrical angle of the motor. In addition, the bias may be determined using a current value instead of a voltage.

[0016] The control device may also have the following features. The information related to the control of the three-phase AC motor includes a parameter indicating the rotation direction of the output shaft notified by the feedback signal, and when the output shaft rotates in the desired direction, the control unit causes the storage unit to store the first information, and when the storage unit stores the first information, the output shaft is set to rotate in the direction opposite to the rotation direction of the output shaft notified by the feedback signal to control the three-phase AC motor. By having such a feature, the control device can control the three-phase AC motor by setting the desired direction to the positive direction.

[0017] Effects of the Invention

[0018] According to the technology disclosed in the present invention, it is possible to obtain information related to the control of a three-phase AC motor in a simpler way. BRIEF DESCRIPTION OF THE DRAWINGS

[0019] [ Figure 1 ] Figure 1 It is a diagram showing an example of a servo system according to an embodiment.

[0020] [ Figure 2 ] Figure 2 The first diagram schematically shows the arrangement order of the U phase, the V phase, and the W phase and the increment counting direction of the encoder when the motor 3 is viewed from the axial direction of the output shaft.

[0021] [ Figure 3 ] Figure 3The second diagram schematically shows the arrangement order of the U phase, the V phase, and the W phase and the increment counting direction of the encoder when the motor 3 is viewed from the axial direction of the output shaft.

[0022] [ Figure 4 ] Figure 4 The third figure schematically shows the arrangement order of the U phase, the V phase, and the W phase and the increment counting direction of the encoder when the motor 3 is viewed from the axial direction of the output shaft.

[0023] [ Figure 5 ] Figure 5 FIG. 4 schematically shows the arrangement order of the U-phase, V-phase, and W-phase and the increment counting direction of the encoder when the motor 3 is viewed from the axial direction of the output shaft.

[0024] [ Figure 6 ] Figure 6 This is a diagram illustrating a state where the output shaft of the motor is rotated by hand.

[0025] [ Figure 7 ] Figure 7 This is a diagram showing a schematic configuration of a functional unit included in the servo driver according to the present embodiment.

[0026] [ Figure 8 ] Figure 8 This is a diagram illustrating the counter electromotive force generated by rotating the output shaft by hand.

[0027] [ Fig. 9 ] Fig. 9 This is a diagram illustrating the electrical angular velocity generated by rotating the output shaft by hand.

[0028] [ Fig.10 ] Fig.10 This is a diagram schematically showing the measurement of a voltage inputted from a motor whose output shaft is rotated manually via a power line.

[0029] [ Fig.11 ] Fig.11 This is a diagram illustrating a time-series change in the measured line voltage.

[0030] [ Fig.12 ] Fig.12 This is a first diagram illustrating the correspondence between the measured line voltage and the electrical angle recognized by the servo driver 2 .

[0031] [ Fig.13 ] Fig.13 The second diagram illustrates the correspondence between the measured line voltage and the electrical angle recognized by the servo driver 2 .

[0032] [ Fig.14 ] Fig.14 This is a diagram illustrating the correspondence between the three-phase voltages measured from the neutral point and the electrical angle.

[0033] [ Fig.15 ] Fig.15 This is a diagram showing an example of a processing flow of a process in which an estimation unit estimates a direction of count-up of an encoder.

[0034] [ Fig.16 ] Fig.16 This is a diagram showing an example of a processing flow of a process in which an estimation unit estimates an encoder bias.

[0035] [ Fig.17 ] Fig.17 This is a diagram schematically showing the measurement of the current input through the power line from the motor whose output shaft is rotated by hand.

[0036] [ Fig.18 ] Fig.18 It is an example of giving Fig. 9 Graph of current values ​​generated at the illustrated electrical angular velocity. DETAILED DESCRIPTION

[0037] <Implementation Method>

[0038] Hereinafter, embodiments will be described with reference to the drawings. Figure 1 1 is a diagram showing an example of a servo system 100 according to an embodiment. The servo system 100 includes a PLC 1, a servo driver 2, a motor 3, and an industrial network N1. The motor 3 includes a motor body 31, an encoder 32, and an output shaft 33. The PLC 1 and the servo driver 2 are connected via the industrial network N1. The servo driver 2 and the motor body 31 are connected via a power line 7. The servo driver 2 and the encoder 32 are connected via an encoder cable 8.

[0039] The PLC 1 outputs a command signal to the servo driver 2 via the industrial network N1. The PLC 1 functions as, for example, a monitoring device for the servo driver 2 by executing processing according to a program prepared in advance. The industrial network N1 is, for example, a TCP / IP network.

[0040] The servo driver 2 receives a command signal from the PLC 1 via the industrial network N1. In addition, the servo driver 2 receives a feedback signal from the encoder 32 of the corresponding motor 3 via the encoder cable 8. In addition, the servo driver 2 supplies a drive current to the motor body 31 of the motor 3 via the power line 7. In the servo driver 2, a servo system for performing feedback control using a speed detector, a torque detector, a power generator, etc. is formed, and the motor 3 is servo-controlled and driven using these signals. The servo driver 2 is an example of a "control device".

[0041] The motor 3 is, for example, a three-phase AC servo motor. The motor 3 includes a motor body 31 and an encoder 32. The motor body 31 receives a driving current from the servo driver 2 via a power line 7. The encoder 32 detects the movement of the motor body 31 through the servo driver 2 and generates a feedback signal representing the detected movement. The feedback signal is output to the servo driver 2 via an encoder cable 8. The feedback signal includes, for example, information about the rotational position (angle) of the output shaft 33 of the motor body 31, information about the rotational speed of the output shaft 33, information about the rotational direction of the output shaft 33, and other information related to the displacement of the output shaft 33. The structure of the encoder 32 can, for example, apply a known incremental or absolute structure. The motor 3 is an example of a "three-phase AC motor".

[0042] Figures 2 to 5 Schematically shows the arrangement order of the U phase, V phase, and W phase when the motor 3 is viewed from the axial direction of the output shaft 33 and the count-up direction of the encoder 32. Figures 2 to 5 , the origin position when the encoder 32 counts the number of rotations of the encoder 32 is also illustrated.

[0043] In the motor 3, the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 are arranged so as to surround the rotor 310 to which the output shaft 33 is attached. The encoder 32 determines that the output shaft 33 is rotating in the direction of the output shaft 331 as the positive direction. In addition, the encoder 32 counts the rotation amount of the output shaft 33 with reference to the encoder origin 320.

[0044] Here, comparison Figure 2 and Figure 3 , the arrangement order of the V-phase coil 312 and the W-phase coil 313 is opposite. Figure 2 and Figure 4 , the encoder increment counting direction 321 is the opposite direction. Figure 2 and Figure 5 , the position of the encoder origin 320 is different. Thus, in the motor 3, the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313, the position of the encoder origin 320, and the encoder increment count direction 321 are sometimes different depending on the model of the motor 3. Therefore, in order to properly perform the servo control of the motor 3 by the servo driver 2, the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313, the position of the encoder origin 320, and the encoder increment count direction 321 are set in advance for the servo driver 2.

[0045] In the present embodiment, the user of the servo system 100 uses the back electromotive force generated by manually rotating the output shaft 33 in the direction that the user wants to set as the positive direction and the feedback signal from the encoder 32 to obtain the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313, the position of the encoder origin 320, and the encoder increment count direction 321, and sets the obtained information to the servo driver 2. The direction that the user wants to set as the positive direction is an example of the "desired direction".

[0046] Figure 6 2 is a diagram illustrating a state where the output shaft 33 of the motor 3 is rotated by hand. Figure 6 In the example of , the output shaft 33 rotates in the counterclockwise direction when viewed from the output shaft 33. The back electromotive force generated by the rotation of the output shaft 33 is input to the servo driver 2 via the power line 7. In addition, the feedback signal of the encoder 32 that detects the rotation of the output shaft 33 is input to the servo driver 2 via the encoder cable 8.

[0047] Figure 7 1 is a diagram showing a schematic configuration of a functional unit included in the servo driver 2 of the present embodiment. The servo driver 2 can be regarded as a computer including a computing device, a storage device, and the like. Figure 7 The functional units shown are realized by executing a predetermined program or the like in the servo driver 2. The servo driver 2 includes a first receiving unit 11, a second receiving unit 12, an estimating unit 13, a setting unit 14, a control unit 15, and a storage unit 16, but may include functional units other than these.

[0048] The first receiving unit 11 obtains the back electromotive force from the motor body 31 via the power line 7. Figure 6 As described above, when the output shaft 33 is rotated by hand, a counter electromotive force is generated. Figure 8 3 is a diagram illustrating the counter electromotive force generated by rotating the output shaft 33 by hand. Figure 8 The vertical axis illustrates the back electromotive force, and the horizontal axis illustrates the time. When the output shaft 33 is rotated by hand, a back electromotive force corresponding to the rotation speed of the output shaft 33 is generated in each of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313. The first receiving unit 11 stores the time series changes of the back electromotive force generated in each of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 received in the storage unit 16. The first receiving unit 11 is an example of a "first acquisition unit". The time series changes of the back electromotive force are an example of "information related to the back electromotive force".

[0049] return Figure 7 The second receiving unit 12 obtains a feedback signal from the encoder 32 via the encoder cable 8 . Fig. 9 3 is a diagram illustrating the electrical angular velocity generated by rotating the output shaft 33 by hand. Fig. 9 The vertical axis shows an example of electrical angular velocity (degrees / second), and the horizontal axis shows an example of time (seconds). When the output shaft 33 is rotated by hand, the rotation direction and rotation speed of the output shaft 33 are detected by the encoder 32. The encoder 32 outputs a feedback signal including information indicating the detected rotation direction and rotation speed of the output shaft 33 to the servo driver 2. The second receiving unit 12 stores the time series change of the rotation speed of the output shaft 33 indicated by the received feedback signal in the storage unit 16. The second receiving unit 12 is an example of a "second acquisition unit".

[0050] return Figure 7 The estimation unit 13 estimates the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313, the encoder bias (offset) for correcting the deviation between the electrical angle of the motor 3 and the origin of the encoder 32 (in other words, the deviation between the dq axis of the servo driver 2 and the dq axis of the motor 3), and the direction in which the output shaft 33 counts the number of revolutions based on the information stored in the storage unit 16 by the first receiving unit 11 and the second receiving unit 12. The estimation unit 13 is an example of a "control unit". The encoder bias is an example of an "offset".

[0051] Estimation unit 13 estimates the order of arrangement of U-phase coil 311, V-phase coil 312, and W-phase coil 313 based on the order of generation of back electromotive force, for example. Estimation unit 13 estimates the direction of count-up of encoder 32 based on the positive or negative rotation speed of output shaft 33 indicated by the feedback signal, for example.

[0052] An example of a process of estimating the arrangement order of the U-phase coil 311 , the V-phase coil 312 , and the W-phase coil 313 using the back electromotive force will be described below. Fig.10 2 is a diagram schematically showing the measurement of the voltage input from the motor 3 through the power line 7 when the output shaft 33 is rotated by hand. The servo driver 2 includes a voltmeter 21, and the voltage input from the motor 3 is measured by the voltmeter 21. When the electrical angular velocity is ω and the two-phase inductance is L d , L q , phase resistance is R, induced voltage constant is K e , d-axis current is i d , q-axis current is i q , when the differential operator is p, the following formula (1) holds.

[0053]

[0054] Since the servo is disconnected, i d =0, i q =0, so the following formula (2) holds.

[0055]

[0056] If the output shaft 33 is rotated by hand, Fig. 9 The electrical angular velocity shown in the example generates Figure 8 Here, it is difficult to measure the back electromotive force by the voltmeter 21. Therefore, in the present embodiment, the first acquisition unit 11 may measure the line voltage by the voltmeter 21 instead of directly measuring the back electromotive force. As the measured line voltage, the voltage between the U phase and the V phase, the voltage between the W phase and the V phase, and the voltage between the U phase and the W phase can be cited. Fig.11 This is a diagram showing the time series change of the measured line voltage. Fig.11 In the example, the vertical axis shows voltage (V) and the horizontal axis shows time (seconds). Fig.11 , the voltage between the W phase and the V phase and the voltage between the U phase and the W phase are exemplified. The measured line voltage is an example of "information related to the back electromotive force".

[0057] The estimation unit 13 can estimate the arrangement order of the U-phase coil 311 , the V-phase coil 312 , and the W-phase coil 313 based on the positive and negative signs of other measured line voltages at the zero-crossing point of a certain measured line voltage. Fig.12 and Fig.13 2 is a diagram illustrating the correspondence between the measured line voltage and the electrical angle recognized by the servo driver 2. Fig.12 and Fig.13 In , the vertical axis shows voltage (V) and the horizontal axis shows electrical angle (degrees). Fig.12 In the example, the arrangement order of the U-phase coil 311, V-phase coil 312, and W-phase coil 313 preset in the servo driver 2 is consistent with the arrangement order of the U-phase coil 311, V-phase coil 312, and W-phase coil 313 in the motor 3. Fig.13 , a case is illustrated in which the arrangement order of the U-phase coil 311 , the V-phase coil 312 , and the W-phase coil 313 preset in the servo driver 2 is different from the arrangement order of the U-phase coil 311 , the V-phase coil 312 , and the W-phase coil 313 in the motor 3 .

[0058] In the servo driver 2 , for example, the correspondence between the change in the measured line voltage acquired by the first acquisition unit 11 and the electrical angle indicated by the feedback signal acquired by the second acquisition unit is stored in the storage unit 16 . Fig.12 and Fig.13 The illustrated correspondence relationship between the measured line voltage and the electrical angle is an example of the “first correspondence relationship”.

[0059] exist Fig.12, the voltage between the U phase and the W phase is 0V at an electrical angle of 180 degrees. The voltage between the W phase and the U phase at an electrical angle of 180 degrees is positive. Thus, the estimation unit 13 estimates that the arrangement order of the pre-set U-phase coil 311, V-phase coil 312, and W-phase coil 313 is consistent with the arrangement order of the U-phase coil 311, V-phase coil 312, and W-phase coil 313 configured in the motor 3. Here, the estimation unit 13 estimates that the U-phase coil 311, V-phase coil 312, and W-phase coil 313 are arranged in this order relative to the direction in which the output shaft 33 is rotated by hand.

[0060] exist Fig.13 , the voltage between the U phase and the W phase is 0V at an electrical angle of 180 degrees. The voltage between the W phase and the U phase at an electrical angle of 180 degrees is negative. Therefore, the estimation unit 13 determines that the pre-set arrangement order of the U phase coil 311, the V phase coil 312, and the W phase coil 313 is opposite to the arrangement order of the U phase coil 311, the V phase coil 312, and the W phase coil 313 configured in the motor 3. Here, the estimation unit 13 estimates that the U phase coil 311, the W phase coil 313, and the V phase coil 312 are arranged in this order relative to the direction in which the output shaft 33 is rotated by hand.

[0061] That is, when a certain measured line voltage is 0 and other measured line voltages are positive, the estimation unit 13 estimates that the pre-set arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 is consistent with the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 configured in the motor 3. In addition, when a certain measured line voltage is 0 and other measured line voltages are negative, the estimation unit 13 estimates that the pre-set arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 is consistent with the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 configured in the motor 3.

[0062] Next, the estimation unit 13 estimates the encoder offset. Here, it is assumed that the estimation unit 13 estimates that the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 are arranged in this order with respect to the direction in which the output shaft 33 is rotated by hand. Fig.12 The zero crossing points of the voltage between the U phase and the W phase are at the electrical angle of 60 degrees and 180 degrees. Fig.12 In the case of 60 degrees of electrical angle, the voltage between the U phase and the W phase decreases. Fig.12 In FIG. 1 , the voltage between the U phase and the W phase increases at the portion of the electrical angle of 180 degrees. That is, the ratio of the change in the voltage between the U phase and the W phase at the electrical angle of 180 degrees is positive.

[0063] Fig.14 This is a diagram illustrating the correspondence between the three-phase voltage measured from the neutral point and the electrical angle. Fig.14This example shows the true value of the electrical angle. Fig.14 The correspondence between the three-phase voltage and the electrical angle may be stored in advance in the storage unit 16 of the servo driver 2, for example. Fig.14 In the diagram, it can be understood that the voltage of the U phase is equal to the voltage of the W phase when the electrical angle is 30 degrees and 210 degrees. Fig.14 In the figure, when the electrical angle is 30 degrees, the voltage between the U phase and the W phase is in a decreasing trend (the ratio of change is negative), and when the electrical angle is 180 degrees, the voltage between the U phase and the W phase is in an increasing trend (the ratio of change is positive).

[0064] The portion where the voltage of the U phase is equal to the voltage of the W phase corresponds to, for example, Fig.14 The zero crossing point of the voltage between phase U and phase W in . Fig.14 Among the zero-crossing points of the voltage between the U-phase and the W-phase shown in the example, the voltage between the U-phase and the W-phase at an electrical angle of 60 degrees tends to decrease, and the voltage between the U-phase and the W-phase at an electrical angle of 180 degrees tends to increase. Fig.14 The illustrated correspondence relationship between the three-phase voltages and the electrical angles is an example of the “second correspondence relationship”.

[0065] That is, to understand Fig.12 The zero-crossing point of the voltage between the U-phase and the W-phase shown in the example is the zero-crossing point of the voltage at an electrical angle of 60 degrees. Fig.14 The electrical angle corresponds to 30 degrees. In addition, it can be understood Fig.12 The zero-crossing point of the voltage between the U-phase and the W-phase shown in the example is the zero-crossing point of the voltage at an electrical angle of 180 degrees. Fig.14 Corresponding to an electrical angle of 210 degrees.

[0066] Here, the encoder bias set for the servo driver 2 can be calculated by subtracting the electrical angle assumed by the servo driver 2 from the true value of the electrical angle. In the present embodiment, for example, at a location where the servo driver 2 assumes an electrical angle of 180 degrees, the true value of the electrical angle is 210 degrees. Therefore, the estimation unit 13 can subtract the electrical angle of 180 degrees assumed by the servo driver 2 from the true value of the electrical angle, that is, 210 degrees, and calculate an electrical angle of 30 degrees as the encoder bias.

[0067] The setting unit 14 causes the servo driver 2 to store the information about the motor 3 estimated by the estimation unit 13 in the storage unit 16. By storing the information about the motor 3 in the storage unit 16, the servo driver 2 can servo-control the motor 3 using the information stored in the storage unit 16.

[0068] The control unit 15 performs feedback control of the motor 3 according to the command signal from the PLC 1, using various information on the motor 3 stored in the storage unit 16 by the setting unit 14. The control unit 15 is an example of a “control unit”.

[0069] The storage unit 16 stores information acquired by the first receiving unit 11 and the second receiving unit 12 and information related to processing performed by the first receiving unit 11, the second receiving unit 12, the estimation unit 13, the setting unit 14, and the control unit 15. The storage unit 16 is, for example, an EEPROM. The storage unit 16 is an example of a "storage unit".

[0070] <Processing Flow>

[0071] Fig.15 1 is a diagram showing an example of a processing flow of the estimation unit 13 for estimating the direction of the encoder's count-up. Fig.15 An example of a process in which the estimation unit 13 estimates the direction of the up-counting of the encoder will be described.

[0072] In S1, the user of the servo system 100 manually rotates the output shaft 33 of the motor 3 in the desired positive rotation direction. In S2, the second receiving unit 12 receives the feedback signal from the encoder 32. The estimation unit 13 determines whether the count value of the encoder indicating the rotation direction of the output shaft 33 indicates the positive direction based on the feedback signal received by the second receiving unit 12. In the case of indicating the positive direction (Yes in S2), the processing is terminated because the direction of the incremental count is correctly set in the servo driver 2. In the case of not being the positive direction (in the case of the negative direction) (No in S2), the processing enters S3. The count value of the encoder indicating the rotation direction of the output shaft 33 is an example of a "parameter indicating the rotation direction of the output shaft".

[0073] In S3, the estimation unit 13 detects that the direction of the increment count pre-stored in the storage unit 16 of the servo driver 2 is opposite to the direction of the increment count of the encoder 32. The setting unit 14 reverses the direction of the increment count pre-stored in the storage unit 16 and stores it in the storage unit 16. The setting unit 14 may also cause the storage unit 16 to store information indicating that the direction of the increment count is the opposite direction to the direction pre-stored in the storage unit 16. For example, when the storage unit 16 stores information indicating that it is the opposite direction, the control unit 15 may count the rotation amount of the output shaft 33 by the decrease in the rotation amount of the output shaft 33 indicated by the feedback signal from the encoder 32. The information indicating that it is the opposite direction is an example of the "first information".

[0074] Fig.16 1 is a diagram showing an example of a processing flow of a process in which the estimation unit 13 estimates the bias of the encoder. Fig.16 In, with Fig.15 The same processes are denoted by the same reference numerals and their descriptions are omitted. Fig.16 , an example of a process in which the estimation unit 13 estimates the bias of the encoder is described.

[0075] In S11, the first receiving unit 11 receives the back electromotive force from the motor 3. The estimating unit 13 estimates the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 based on the positive and negative of other measured line voltages at the zero-crossing point of a certain measured line voltage. When the estimated arrangement order is consistent with the arrangement order preset for the servo driver 2 (Yes in S11), the arrangement order of the U-phase, V-phase, and W-phase is correctly set in the servo driver 2, and the processing proceeds to S12. When the estimated arrangement order is inconsistent with the arrangement order preset for the servo driver 2 (No in S11), the processing proceeds to S13.

[0076] In S12, the estimation unit 13 calculates the encoder bias of the encoder 32 for correcting the deviation between the dq axis of the servo driver 2 and the dq axis of the motor 3. The setting unit 14 stores the calculated encoder bias in the storage unit 16.

[0077] In S13, the setting unit 14 changes the order of the U phase, V phase, and W phase pre-stored in the storage unit 16 of the servo driver 2 to the reverse order and stores it in the storage unit 16. That is, the setting unit 14 stores the order of the U phase, V phase, and W phase in the storage unit 16 according to the generation order of the back electromotive force obtained in S11.

[0078] <Effects of Implementation Methods>

[0079] In the present embodiment, by manually rotating the output shaft 33 in a direction desired by the user, information about the motor 3 is obtained and stored in the storage unit 16. Furthermore, the control unit 15 can control the motor 3 by using the information stored in the storage unit 16. That is, according to the present embodiment, information about the motor 3, which is a three-phase AC motor, can be stored in the storage unit 16 by a simple method.

[0080] In the present embodiment, for example, the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 is estimated based on the time series change of the back electromotive force generated by manual rotation of the output shaft 33, and the estimated arrangement order is stored in the storage unit 16. The control unit 15 can drive the motor 3 by supplying current to the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 by referring to the arrangement order stored in the storage unit 16.

[0081] In the present embodiment, the estimation unit 13 determines whether the count value of the encoder indicating the rotation amount of the output shaft 33 increases based on the feedback signal when the output shaft 33 is manually rotated. In addition, when the count value decreases, the estimation unit 13 detects that the direction of the increment count pre-stored in the storage unit 16 is opposite to the direction of the increment count of the encoder 32. In addition, the setting unit 14 can make the desired direction consistent with the direction of the increment count by reversing the direction of the increment count pre-stored in the storage unit 16. In addition, the setting unit 14 can also make the storage unit 16 store information indicating that the direction of the increment count is the opposite direction to the direction pre-stored in the storage unit 16.

[0082] In addition, in the present embodiment, the estimation unit 13 estimates the encoder bias for correcting the deviation between the electrical angle of the motor 3 and the origin of the encoder 32. Therefore, according to the present embodiment, even if there is a deviation between the origin of the encoder 32 and the electrical angle of 0 degrees of the motor 3, the servo driver 2 can correct the deviation and control the motor 3. For example, when the electrical angle of 0 degrees exists at the position of 10000 pulses, the servo driver 2 can control the motor 3 by setting the encoder bias to 10000 pulses.

[0083] <First Modification>

[0084] In the embodiment, the order of arrangement of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 is estimated using the measured line voltage generated when the output shaft 33 is rotated by hand, but the order of arrangement of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 may be estimated using, for example, the current generated when the output shaft 33 is rotated by hand. In the first modified example, the process of estimating the order of arrangement of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 using the current generated when the output shaft 33 is rotated by hand is described.

[0085] Fig.17 1 is a diagram schematically showing the measurement of the current input from the motor 3 through the power line 7, the output shaft 33 of which is rotated by hand. The servo driver 2 is provided with ammeters 22a, 22b, and 22c. The current value of the U phase is measured by the voltmeter 22a, the current value of the V phase is measured by the ammeter 22b, and the current value of the W phase is measured by the ammeter 22c. In addition, when measuring the current value, for example, in the servo driver 2, the U phase, the V phase, and the W phase are short-circuited.

[0086] Here, it is assumed that the output shaft 33 is rotated by hand to impart Fig. 9 The illustrated electrical angular velocity. Fig.18 It is an example of giving Fig. 9 The current value generated when the electrical angular velocity is shown in FIG. Fig.18 In the figure, the vertical axis shows the current (A) and the horizontal axis shows the time (seconds).

[0087] In the above formula (1), V d and V q is 0, so the following formula (3) holds.

[0088]

[0089] If equation (3) is approximated and the differential term is considered to be 0, the following equation (4) can be obtained. In addition, by manually rotating the output shaft 33, ω 2 is small enough to be ignored d Item.

[0090]

[0091] Furthermore, the arrangement order of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 in the motor 3, and the estimation and reference of the encoder bias set for the servo driver 2 are Fig.12 and Fig.13 The method described using voltage can also be estimated using current. The estimation unit 13 can be based on, for example, Fig.18 The order of arrangement of the U-phase coil 311, the V-phase coil 312, and the W-phase coil 313 of the motor 3 is estimated based on the positive or negative current value of the V-phase at the zero-crossing point of the current of the U-phase. In addition, the estimation unit 13 can estimate the encoder bias based on the positive or negative ratio of the change in the current value of the U-phase at the zero-crossing point of the current of the U-phase, for example. As an example, the estimation unit 13 can estimate that when the ratio of the change in the current value of the U-phase at the zero-crossing point of the current of the U-phase is positive, the direction of the q-axis current is 270 degrees, and the electrical angle (the angle of the d-axis) is 180 degrees.

[0092] The above-described embodiments and modifications can be combined.

[0093] <Additional Note 1>

[0094] A control device (2) controls a three-phase AC motor (3), the three-phase AC motor (3) comprising: an encoder (32) which outputs a feedback signal indicating the rotation state of an output shaft (33); and a U-phase coil (311), a V-phase coil (312) and a W-phase coil (313), the control device (2) comprising: a first acquisition unit (11) which acquires the rotation state of the U-phase coil (311), the V-phase coil (312) and the W-phase coil (313) caused by causing the output shaft (33) to rotate in a desired direction by an external force. Information related to the back electromotive force generated in the coil (313); a second acquisition unit (12), which obtains the feedback signal containing information related to the rotation of the output shaft (33) rotated by the external force from the encoder (32); and a control unit (13, 15), which estimates information related to the control of the three-phase AC motor (3) based on the information related to the back electromotive force and the feedback signal, and uses the estimated information related to the control of the three-phase AC motor (3) to control the three-phase AC motor (3).

[0095] Description of symbols

[0096] 1: PLC; 2: servo driver; 3: motor; 7: power line; 8: encoder cable; 11: first receiving unit; 12: second receiving unit; 13: estimation unit; 14: setting unit; 15: control unit; 16: storage unit; 21: voltmeter; 22a, 22b, 22c: ammeter; 31: motor body; 32: encoder; 33: output shaft; 100: servo system; 310: rotor; 311: U-phase coil; 312: V-phase coil; 313: W-phase coil; 320: encoder origin; 321: encoder increment counting direction; 500: arrow.

Claims

1. A control device for controlling a three-phase AC motor, the three-phase AC motor comprising: an encoder that outputs a feedback signal indicating a rotation state of an output shaft; and a U-phase coil, a V-phase coil, and a W-phase coil, the control device comprising: a first acquisition unit that acquires information on back electromotive force generated in the U-phase coil, the V-phase coil, and the W-phase coil when the output shaft is rotated in a desired direction by an external force; a second acquisition unit that acquires, from the encoder, the feedback signal including information on the rotation of the output shaft rotated by the external force; and A control unit estimates information related to control of the three-phase AC motor based on the information related to the back electromotive force and the feedback signal, and controls the three-phase AC motor using the estimated information related to control of the three-phase AC motor.

2. The control device according to claim 1, wherein: The control unit estimates an arrangement order of the U-phase coil, the V-phase coil, and the W-phase coil based on information about the back electromotive force, and controls the three-phase AC motor using the estimated arrangement order of the U-phase coil, the V-phase coil, and the W-phase coil.

3. The control device according to claim 2, wherein: The information related to the back electromotive force includes a first correspondence between the voltage and the electrical angle between any two phases of the U phase, the V phase, and the W phase. The control unit obtains the positive and negative ratio of the change in the voltage between the two phases when the voltage between the two phases is 0 in the first correspondence and the first electrical angle when the voltage between the two phases is 0, and determines an offset for correcting the deviation of the electrical angle of the three-phase AC motor from the origin of the encoder based on the second correspondence between the voltage and electrical angle of the U-phase, V-phase and W-phase respectively stored in the storage unit, the positive and negative ratio of the change in the voltage and the first electrical angle, and the estimated arrangement order of the U-phase coil, the V-phase coil and the W-phase coil, and uses the determined offset to control the three-phase AC motor.

4. The control device according to claim 2, wherein: The information related to the back electromotive force includes a third correspondence between the current value of any phase among the U phase, the V phase and the W phase and the electrical angle. The control unit obtains the positive and negative proportion of the change in the current value when the current value is 0 and the second electrical angle when the current value is 0 in the third correspondence, and determines an offset for correcting the deviation of the electrical angle of the three-phase AC motor from the origin of the encoder based on the fourth correspondence between the current value and the electrical angle of the U-phase, V-phase and W-phase respective current values ​​and the electrical angles pre-stored in the storage unit, the obtained positive and negative proportion of the change in the current value and the second electrical angle, and the estimated arrangement order of the U-phase coil, the V-phase coil and the W-phase coil, and uses the determined offset to control the three-phase AC motor.

5. The control device according to any one of claims 1 to 4, wherein: The information related to the control of the three-phase AC motor includes a parameter indicating the rotation direction of the output shaft notified by the feedback signal, When the parameter of the rotation direction of the output shaft notified by the feedback signal indicates a negative direction when the output shaft rotates in the desired direction, the control unit causes the storage unit to store the first information, and when the storage unit stores the first information, sets the output shaft to rotate in a direction opposite to the rotation direction of the output shaft notified by the feedback signal to control the three-phase AC motor.