Drive control device
The drive control device estimates motor torque using PWM control and duty ratio calculations, addressing the size increase issue by eliminating current detection circuits, thus maintaining a compact design and reducing costs.
Patent Information
- Application Number
- JP2023080710
- Authority / Receiving Office
- JP · JP
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2023-05-16
- Publication Date
- 2024-11-28
AI Technical Summary
Existing motor drive control devices increase in size due to the need for circuits to detect current for torque estimation, which is necessary for detecting abnormalities like wear and deterioration.
A drive control device that employs PWM control to calculate a duty ratio based on motor rotation speed and target rotation speed, estimating torque using a torque estimating section that calculates torque based on motor rotation speed and duty ratio without requiring additional current detection circuits.
Enables torque estimation while maintaining a compact device size and reducing costs by eliminating the need for current detection circuits.
Smart Images

Figure 2024164958000001_ABST
Abstract
Description
[Technical field]
[0001] The present invention relates to a drive control device that drives a motor. [Background technology]
[0002] There are cases where it is necessary to estimate the torque of a motor while it is running. For example, in a printing device equipped with a motor that drives a transport roller that transports paper used for printing, there is a demand to estimate the torque of the motor in order to detect abnormalities such as wear and deterioration of the transport roller.
[0003] In response to this, a technique is known in which the current flowing through a motor is detected and the detected current is converted into torque using the proportionality characteristic between the torque generated by the motor and the current flowing through the motor (see Patent Document 1). [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2020-35394 A Summary of the Invention [Problem to be solved by the invention]
[0005] However, the above-mentioned technique requires a circuit for detecting the current flowing through the motor, which leads to an increase in the size of the motor drive control device.
[0006] The present invention has been made in view of the above, and has an object to provide a drive control device that can estimate motor torque while preventing the device from becoming large. [Means for solving the problem]
[0007] In order to achieve the above-mentioned object, the drive control device of the present invention is a drive control device that drives a motor using PWM control, and is characterized in that it includes a calculation unit that calculates a duty ratio of a PWM signal based on the motor rotation speed and a target rotation speed, and a torque estimation unit that obtains an estimated value of the motor torque based on the motor rotation speed and the duty ratio calculated by the calculation unit. Effect of the Invention
[0008] According to the drive control device of the present invention, it is possible to estimate the torque of the motor while preventing the device from becoming large in size. [Brief description of the drawings]
[0009] [Figure 1] 1 is a schematic configuration diagram of a drive control device according to a first embodiment. [Diagram 2] FIG. 11 is a diagram showing an example of the relationship between the measured torque value and the rotation speed of a motor for each duty ratio of a PWM signal. [Diagram 3] 3 is a diagram showing the slope and intercept of a characteristic line of the torque of the motor for each duty ratio of a PWM signal, extracted from the measured torque values of the motor shown in FIG. 2. [Figure 4] 5 is a diagram showing an example of a slope and an intercept of a characteristic line of the torque of the motor in the first embodiment. FIG. [Diagram 5] 13 is a diagram showing an example of a slope and an intercept of a characteristic line of the torque of a motor in the second embodiment. FIG. [Figure 6] FIG. 6 is a diagram showing a portion of a graph comparing the intercepts shown in FIG. 3, FIG. 4, and FIG. 5, respectively. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] Hereinafter, an embodiment of the present invention will be described with reference to the drawings. In the drawings, the same or equivalent parts or components are denoted by the same or equivalent reference numerals, and the description thereof will be omitted or simplified.
[0011] [First embodiment] Fig. 1 is a schematic configuration diagram of a drive control device according to a first embodiment of the present invention. As shown in Fig. 1, the drive control device 1 according to the first embodiment includes a control unit 2, a motor driver 3, a power supply unit 4, and a speed detector 5.
[0012] The drive control device 1 drives a DC motor 6. The motor 6 drives, for example, a transport roller that transports paper in a printing device.
[0013] The control unit 2 controls the motor driver 3 by PWM (Pulse Width Modulation) control. The control unit 2 is configured by a microcomputer having a CPU, a memory, etc. The control unit 2 includes a PWM calculation unit (corresponding to a calculation unit) 11, a PWM signal generation unit 12, a rotation speed detection unit 13, and a torque estimation unit 14. Each unit of the control unit 2 is configured by the CPU executing a program, etc.
[0014] The PWM calculation unit 11 calculates a duty ratio of a PWM signal based on the rotation speed and a target rotation speed of the motor 6. The PWM calculation unit 11 includes a subtraction unit 21, a PID calculation unit 22, a back electromotive force calculation unit 23, an addition unit 24, and a duty ratio calculation unit 25.
[0015] The subtraction unit 21 subtracts the rotation speed of the motor 6 detected by the rotation speed detection unit 13 from the target rotation speed, which is a target value of the rotation speed of the motor 6, to calculate a deviation speed.
[0016] The PID calculation unit 22 performs PID calculation based on the deviation speed calculated by the subtraction unit 21. The PID calculation unit 22 includes a proportional calculation unit 31, an integral calculation unit 32, and a differential calculation unit 33.
[0017] The proportional calculation unit 31 multiplies the deviation speed by a proportional gain to calculate a proportional calculation value.
[0018] The integral calculation unit 32 integrates the deviation speed over time, and multiplies the obtained value (amount of displacement) by an integral gain to calculate an integral calculation value.
[0019] The differential calculation unit 33 differentiates the deviation speed with respect to time, and multiplies the obtained value (acceleration) by a differential gain to calculate a differential calculation value.
[0020] The back electromotive voltage calculation unit 23 multiplies the rotation speed of the motor 6 detected by the rotation speed detection unit 13 by a back electromotive voltage constant to calculate the back electromotive voltage of the motor 6. The back electromotive voltage is a voltage generated by the rotation of the motor 6 itself.
[0021] The adder 24 adds together the proportional calculation value calculated by the proportional calculation unit 31, the integral calculation value calculated by the integral calculation unit 32, the differential calculation value calculated by the differential calculation unit 33, and the back electromotive voltage calculated by the back electromotive voltage calculation unit 23, to calculate the drive voltage of the motor 6.
[0022] The duty ratio calculation unit 25 calculates the duty ratio of the PWM signal according to the drive voltage calculated by the addition unit 24.
[0023] The PWM signal generating unit 12 generates a PWM signal having a duty ratio calculated by the duty ratio calculating unit 25 .
[0024] The rotation speed detection unit 13 calculates the rotation speed of the motor 6 based on the period of the pulse signal output by the speed detector 5 .
[0025] The torque estimation unit 14 obtains an estimate of the torque of the motor 6 (estimated torque value) based on the rotation speed of the motor 6 detected by the rotation speed detection unit 13 and the duty ratio of the PWM signal calculated by the duty ratio calculation unit 25.
[0026] The motor driver 3 drives the motor 6 based on the PWM signal generated by the PWM signal generating unit 12 .
[0027] The power supply unit 4 supplies a voltage to the motor driver 3 .
[0028] The speed detector 5 outputs a pulse signal corresponding to the rotation angle of the motor 6. The speed detector 5 is, for example, a rotary encoder.
[0029] Next, the operation of the drive control device 1 will be described.
[0030] While the motor 6 is being driven, the speed detector 5 outputs a pulse signal corresponding to the rotation angle of the motor 6. The rotation speed detection unit 13 calculates the rotation speed of the motor 6 based on the period of the pulse signal output by the speed detector 5, and outputs the calculated rotation speed to the subtraction unit 21, the back electromotive force calculation unit 23, and the torque estimation unit 14.
[0031] The subtraction unit 21 subtracts the rotation speed input from the rotation speed detection unit 13 from the target rotation speed to calculate the deviation speed, and outputs the calculated deviation speed to the proportional calculation unit 31, the integral calculation unit 32, and the differential calculation unit 33 of the PID calculation unit 22.
[0032] In the PID calculation unit 22, the proportional calculation unit 31 calculates a proportional calculation value based on the deviation speed. The integral calculation unit 32 calculates an integral calculation value based on the deviation speed. The differential calculation unit 33 calculates a differential calculation value based on the deviation speed. The proportional calculation unit 31, the integral calculation unit 32, and the differential calculation unit 33 output the calculated proportional calculation value, the integral calculation value, and the differential calculation value to the addition unit 24, respectively.
[0033] Furthermore, the back electromotive voltage calculation unit 23 calculates the back electromotive voltage of the motor 6 based on the rotation speed input from the rotation speed detection unit 13, and outputs the calculated back electromotive voltage to the addition unit 24.
[0034] The adder 24 adds the proportional calculation value, the integral calculation value, the differential calculation value, and the back electromotive voltage to calculate a drive voltage for the motor 6 , and outputs the calculated drive voltage to a duty ratio calculation unit 25 .
[0035] The duty ratio calculation unit 25 converts the drive voltage input from the addition unit 24 into a duty ratio of a PWM signal, and outputs the calculated duty ratio to the PWM signal generation unit 12.
[0036] The PWM signal generating unit 12 generates a PWM signal having the duty ratio input from the duty ratio calculating unit 25 , and outputs this PWM signal to the motor driver 3 .
[0037] The motor driver 3 applies a drive voltage to the motor 6 according to the PWM signal input from the PWM signal generating unit 12. As a result, a current according to the inductance of the motor 6, the winding resistance of the motor 6, the drive voltage, and the back electromotive voltage flows through the motor 6, and the motor 6 generates a torque proportional to the current and rotates. The rotation of the motor 6 drives, for example, a conveyance roller of a printing device connected to the motor 6.
[0038] The torque estimation unit 14 calculates a torque estimation value based on the rotation speed input from the rotation speed detection unit 13 and the duty ratio input from the duty ratio calculation unit 25. A method for calculating the torque estimation value will be described later. The torque estimation unit 14 outputs the calculated torque estimation value to an external monitoring device. The monitoring device detects abnormalities such as wear and deterioration of a conveying roller of a printing device connected to the motor 6, for example, based on the torque estimation value of the motor 6.
[0039] Next, a method for calculating the torque estimate value will be described.
[0040] 2 is a diagram showing an example of the relationship between the measured value of torque T of the motor 6 and the rotation speed for each duty ratio P of the PWM signal in the drive control device 1. It can be seen from FIG. 2 that the characteristic line of torque T, which indicates the relationship between torque T and rotation speed, slides according to the duty ratio P.
[0041] Since the rotation speed and the rotation number are in a proportional relationship, based on the relationship between the torque T and the rotation number shown in FIG. 2, the characteristic line of the torque T can be approximated by the following equation (1), which is a first-order polynomial with the rotation speed ω of the motor 6 as a variable.
[0042] T = a × ω + b … (1) Here, as described above, since the characteristic line of the torque T slides according to the duty ratio P, the intercept b of the formula (1) becomes a value according to the duty ratio P. In other words, the intercept b is a variable of the duty ratio P.
[0043] FIG. 3 shows the slope and intercept of the characteristic line of torque T for each duty ratio P, extracted from the measured values of torque T shown in FIG.
[0044] The gradient a in the formula (1) can be set to, for example, the average value of the gradient values at each duty ratio P shown in FIG.
[0045] On the other hand, from the relationship between the duty ratio P and the intercept in FIG. 3, the intercept b of the formula (1) can be approximated by the following formula (2), which is a first-order polynomial with the duty ratio P as a variable.
[0046] b = ba × P + bb … (2) The values of the slope ba and intercept bb in the formula (2) are the slope and intercept values of a regression line obtained by linearly approximating the intercept values at each duty ratio P shown in FIG.
[0047] From equations (1) and (2), the following equation (3) is obtained.
[0048] T = a × ω + (ba × P + bb) … (3) Since the torque T is expressed by equation (3), the torque estimation unit 14 calculates the torque T as a torque estimation value using equation (3) based on the rotation speed ω input from the rotation speed detection unit 13 and the duty ratio P input from the duty ratio calculation unit 25. Here, a, ba, and bb in equation (3) are coefficients according to the torque characteristics of the motor 6 driven and controlled by the drive control device 1, and these values are calculated in advance by experiments or the like in the drive control device 1.
[0049] In the example shown in Figures 2 and 3, the slope a of equation (1) and the intercept b of equation (1) expressed by equation (2) are calculated as shown in Figure 4. In this example, the torque T is calculated as a torque estimate value using equation (3) based on the slope ba and intercept bb of the straight line indicating the slope a and intercept b in Figure 4.
[0050] As described above, in the drive control device 1, the torque estimation unit 14 obtains a torque estimation value based on the rotation speed of the motor 6 and the duty ratio of the PWM signal. This makes it possible to estimate the torque of the motor 6 without providing a dedicated circuit such as a current detection circuit used to detect the current flowing through the motor 6 and convert it into torque. Therefore, the drive control device 1 makes it possible to estimate the torque of the motor 6 while preventing the device from becoming larger. In addition, it makes it possible to estimate the torque of the motor 6 while preventing an increase in cost.
[0051] Specifically, the torque estimation unit 14 calculates the torque estimation value using equation (3) based on the rotation speed of the motor 6 and the duty ratio of the PWM signal. By calculating the torque estimation value using a formula in this manner, it is possible to estimate the torque of the motor 6 without providing a dedicated circuit.
[0052] [Second embodiment] Next, a second embodiment will be described in which the process for obtaining the torque estimation value in the torque estimation unit 14 of the first embodiment described above is changed.
[0053] The intercept b of the above-mentioned equation (1) can be approximated by the following equation (4), which is a quadratic polynomial with the duty ratio P as a variable.
[0054] b = bc × P 2 +bd×P+be …(4) The values of the coefficients bc, bd, and be in the formula (4) are the coefficients of a quadratic formula obtained by quadratic approximation using the least squares method or the like from the intercept values at each duty ratio P shown in FIG.
[0055] From equations (1) and (4), the following equation (5) is obtained.
[0056] T = a × ω + (bc × P 2 +bd×P+be) …(5) In the second embodiment, the torque estimation unit 14 calculates the torque T as a torque estimation value using equation (5) based on the rotation speed ω input from the rotation speed detection unit 13 and the duty ratio P input from the duty ratio calculation unit 25. Here, the values of a, bc, bd, and be in equation (5) are coefficients according to the torque characteristics of the motor 6 driven and controlled by the drive control device 1, and these values are calculated in advance by the drive control device 1 through experiments or the like.
[0057] In the examples shown in Figures 2 and 3, the intercept b of equation (1) expressed by equation (4) is calculated as shown in Figure 5. Figure 5 also shows the slope a similar to that shown in Figure 4. In this example, the torque T is calculated as a torque estimation value using equation (5) based on the slope a in Figure 5 and the coefficients bc, bd, and be of the quadratic curve showing the intercept b.
[0058] Here, Fig. 6 shows a part of a graph comparing the intercepts shown in Fig. 3, Fig. 4, and Fig. 5. As mentioned above, the intercepts in Fig. 3 are the intercepts of the characteristic line of torque T for each duty ratio P extracted from the measured values of torque T shown in Fig. 2. As mentioned above, the intercepts in Fig. 4 and Fig. 5 are the intercepts b expressed by equations (2) and (4), respectively.
[0059] As shown in Fig. 6, the deviation from the intercept of the characteristic line extracted from the measured values is smaller for intercept b expressed by equation (4) than for intercept b expressed by equation (2). Therefore, equation (5) can obtain the torque estimation value with higher accuracy than equation (3).
[0060] As described above, in the second embodiment, the torque estimation unit 14 calculates the torque estimation value using equation (5) based on the rotation speed of the motor 6 and the duty ratio of the PWM signal. That is, the torque estimation unit 14 calculates the intercept b of equation (1) using equation (4), which is a quadratic polynomial with the duty ratio P as a variable. This can improve the accuracy of the torque estimation value.
[0061] [Other embodiments] As described above, the present invention has been described by the first and second embodiments, but the descriptions and drawings forming part of this disclosure should not be understood as limiting the present invention. Various alternative embodiments, examples and operating techniques will become apparent to those skilled in the art from this disclosure.
[0062] In the first and second embodiments described above, the torque estimation value is calculated by a formula based on the rotation speed of the motor 6 and the duty ratio of the PWM signal. However, a table that associates the rotation speed, the duty ratio, and the torque estimation value may be stored in advance in the drive control device 1, and the torque estimation unit 14 may refer to this table to determine the torque estimation value based on the rotation speed and the duty ratio.
[0063] In the above-described first embodiment, the intercept b of formula (1) is calculated using formula (2), which is a first-order polynomial with the duty ratio P as a variable. In the above-described second embodiment, the intercept b of formula (1) is calculated using formula (4), which is a second-order polynomial with the duty ratio P as a variable. However, the present invention is not limited to these, and for example, the intercept b of formula (1) may be calculated using a third-order or higher polynomial with the duty ratio P as a variable.
[0064] Thus, the present invention naturally includes various embodiments not described herein. Therefore, the technical scope of the present invention is defined only by the invention-specifying matters related to the scope of the claims appropriate from the above description.
[0065] [Note] This application discloses the following inventions.
[0066] (Appendix 1) A drive control device that drives a motor by PWM control, A calculation unit that calculates a duty ratio of a PWM signal based on a rotation speed of the motor and a target rotation speed; a torque estimation unit that calculates an estimated value of a torque of the motor based on the rotation speed of the motor and the duty ratio calculated by the calculation unit; A drive control device comprising:
[0067] (Appendix 2) The drive control device described in Appendix 1, characterized in that the torque estimation unit calculates the estimated value based on the motor rotation speed and the duty ratio calculated by the calculation unit, using a first-order polynomial with the motor rotation speed as a variable and an intercept whose value corresponds to the duty ratio of the PWM signal.
[0068] (Appendix 3) 3. The drive control device according to claim 2, wherein the torque estimation unit calculates the intercept using a first-order polynomial with a duty ratio of a PWM signal as a variable.
[0069] (Appendix 4) 3. The drive control device according to claim 2, wherein the torque estimation unit calculates the intercept using a quadratic polynomial with a duty ratio of a PWM signal as a variable. [Explanation of symbols]
[0070] 1 Drive control device 2. Control section 3 Motor Driver 4 Power supply section 5 Speed detector 6 Motor 11 PWM calculation section 12 PWM signal generation section 13 Rotational speed detector 14 Torque Estimation Unit 21 Subtraction section 22 PID calculation section 23 Back electromotive force calculation section 24 Addition section 25 Duty ratio calculation section 31 Proportional calculation section 32 Integral calculation section 33 Differential operation section
Claims
1. A drive control device that drives a motor by PWM control, A calculation unit that calculates a duty ratio of a PWM signal based on a rotation speed of the motor and a target rotation speed; a torque estimation unit that calculates an estimated value of a torque of the motor based on the rotation speed of the motor and the duty ratio calculated by the calculation unit; A drive control device comprising:
2. 2. The drive control device according to claim 1, wherein the torque estimation unit determines the estimated value based on the rotation speed of the motor and the duty ratio calculated by the calculation unit, using a first-order polynomial in which the rotation speed of the motor is a variable and an intercept is a value corresponding to the duty ratio of the PWM signal.
3. 3. The drive control device according to claim 2, wherein the torque estimation unit calculates the intercept by using a first-order polynomial that uses a duty ratio of a PWM signal as a variable.
4. 3. The drive control device according to claim 2, wherein the torque estimation unit calculates the intercept by using a quadratic polynomial that uses a duty ratio of a PWM signal as a variable.
Citation Information
Patent Citations
Disturbance observer, control device, machine tool and disturbance estimation method
JP2020035394A
