Servo control device, servo control method and servo control system
11579570 · 2023-02-14
Assignee
Inventors
Cpc classification
G05B19/19
PHYSICS
G05B11/42
PHYSICS
G05B13/024
PHYSICS
B65H2220/02
PERFORMING OPERATIONS; TRANSPORTING
International classification
Abstract
A servo control device to execute an operation in a discrete time system may include a velocity feedback path having a difference means calculating a pseudo-velocity from a detected position and a lowpass filter, and a PI control means executing a proportional integration control operation on a deviation between the pseudo-velocity and the position deviation to create a drive command for the driver. The velocity feedback path includes a first gain means applying a first gain to the pseudo-velocity, a delay means delaying the pseudo-velocity, and a second gain means applying a second gain to the delayed pseudo-velocity. A sum of an output of the first gain means and the second gain means is inputted to the lowpass filter, and “F.sub.a(z)=1/(1−z.sup.−1F.sub.b(z))” is satisfied where a transfer function of the PI control means is F.sub.a(z), and a transfer function of the lowpass filter is F.sub.b(z).
Claims
1. A servo control device structured to control a driver which operates an operation object on a basis of a position command and to execute an operation in a discrete time system, the servo control device comprising: a calculating means configured to calculate a position deviation based on the position command and a detected position which is negatively fed back; a velocity feedback path which comprises at least a difference means, which calculates a pseudo-velocity from the detected position, and a lowpass filter; and a PI control means configured to execute a proportional integration control operation on a deviation between the pseudo-velocity inputted through the velocity feedback path and the position deviation to create a drive command for the driver; wherein the velocity feedback path further comprises: a first gain means which applies a first gain H1 to the pseudo-velocity; a delay means which delays the pseudo-velocity; and a second gain means which applies a second gain H2 to the pseudo-velocity delayed by the delay means; wherein a sum of an output of the first gain means and an output of the second gain means is inputted to the lowpass filter;
wherein the expression Fa(z)=1/(1−z−1Fb(z)) is satisfied; where a transfer function of the PI control means is Fa(z), and a transfer function of the lowpass filter is Fb(z); wherein “z” is a leading operator in the discrete time system; z−1 is a delay operator; “Fb(z)=q0z/(δ+q0)”, where δ=z−1; q0 is a coefficient of a primary low-pass filter defined by Fb(z) in a discrete time system; when a velocity proportional control gain when the driver is driven by the drive command is G, a transfer function P(z) obtained by combining the driver and the operation object is modeled as r0z/(δ2+p1δ), and a position command response characteristic from the position command to the detected position is m0z/(δ2+m1δ+m0),
G=m0/r0,
H.sub.1=−(p1−m1+m0−q0)/(m0q0), and
H.sub.2={(m1−m0)/m0}−H1; wherein r0 is a coefficient of the transfer function P(z) in a discrete time system obtained by modeling a control object element; m0, m1 are coefficients; and p1 is a coefficient of a denominator polynomial of the transfer function P(z) in a discrete time system obtained by modeling the control object element.
2. A servo control system comprising: the servo control device defined in claim 1; and the driver.
3. The servo control system according to claim 2, wherein “F.sub.b(z)=q.sub.0z/(δ+q.sub.0)”, where δ=z−1.
4. The servo control system according to claim 3, wherein when a velocity proportional control gain when the driver is driven by the drive command is G, a transfer function P(z) obtained by combining the driver and the operation object is modeled as r0z/(δ2+p1δ), and a position command response characteristic from the position command to the detected position is m0z/(δ2+m1δ+m0),
G=m0/r0,
H1=−(p1−m1+m0−q0)/(m0q0), and
H2={(m1−m0)/m0}−H1.
5. A servo control method configured to execute calculations in a discrete time system and to control a driver configured to operate an operation object on a basis of a position command, the servo control method comprising: a calculation step in which a position deviation is calculated based on the position command and a detected position which is negatively fed back; a feedback step in which a pseudo-velocity is calculated from the detected position by a difference operation to feed back the pseudo-velocity; and a creation step in which a proportional integration control operation is executed on a deviation between the pseudo-velocity fed back and the position deviation to create a drive command for the driver; wherein the feedback step comprises: a first gain applying step in which a first gain H1 is applied to the pseudo-velocity; a delay step in which the pseudo-velocity is delayed; a second gain applying step in which a second gain H2 is applied to the pseudo-velocity which is delayed by the delay step; and an input step in which a sum of the pseudo-velocity to which the first gain H1 is applied and the pseudo-velocity to which the second gain H2 is applied is inputted to a lowpass filter; wherein “Fa(z)=1/(1−z−1Fb(z))” is satisfied; where a transfer function in the proportional integration control operation is Fa(z), and a transfer function of the lowpass filter is Fb(z), “Fb(z)=q0z/(δ+q0)”, where δ=z−1; gO is a coefficient of a primary low-pass filter defined by Fb(z) in the discrete time system; when a velocity proportional control gain when the driver is driven by the drive command is G, a transfer characteristic P(z) obtained by combining the driver and the operation object is modeled as rOz/(δ2+p1δ), and a position command response characteristic from the position command to the detected position is mOz/(δ2+m1δ+mO),
G=m0/r0,
H1=−(p1−m1+m0−q0)/(m0q0), and
H2={(m1−m0)/m0}−H1 where rO is a coefficient of the transfer function P(z) in the discrete time system obtained by modeling a control object element; m0, ml are coefficients; and p1 is a coefficient of a denominator polynomial of the transfer function P(z) in the discrete time system obtained by modeling the control object element.
6. A servo control device structured to control a driver which operates an operation object on a basis of a position command and to execute an operation in a discrete time system, the servo control device comprising: a calculating circuit configured to calculate a position deviation based on the position command and a detected position which is negatively fed back; a velocity feedback path which comprises at least a difference circuit, which calculates a pseudo-velocity from the detected position, and a lowpass filter; and a PI controller configured to execute a proportional integration control operation on a deviation between the pseudo-velocity inputted through the velocity feedback path and the position deviation to create a drive command for the driver; wherein the velocity feedback path further comprises: a first gain circuit which applies a first gain H1 to the pseudo-velocity; a delay circuit which delays the pseudo-velocity; and a second gain circuit which applies a second gain H2 to the pseudo-velocity delayed by the delay circuit; wherein a sum of an output of the first gain circuit and an output of the second gain circuit is inputted to the lowpass filter; and
wherein the expression Fa(z)=1/(1−z−1Fb(z)) is satisfied; where a transfer function of the PI controller is Fa(z), and a transfer function of the lowpass filter is Fb(z); wherein “z” is a leading operator in at the discrete time system; z−1 is a delay operator, “Fb(z)=q0z/(δ+q0)”, where δ=z−1; gO is a coefficient of a primary low-pass filter defined by Fb(z) in the discrete time system; when a velocity proportional control gain when the driver is driven by the drive command is G, a transfer characteristic P(z) obtained by combining the driver and the operation object is modeled as rOz/(δ2+p1δ), and a position command response characteristic from the position command to the detected position is mOz/(δ2+m1δ+mO),
G=m0/r0,
H1=−(p1−m1+m0−q0)/(m0q0), and
H2={(m1−m0)/m0}−H1 where rO is a coefficient of the transfer function P(z) in the discrete time system obtained by modeling a control object element; m0, ml are coefficients; and p1 is a coefficient of a denominator polynomial of the transfer function P(z) in the discrete time system obtained by modeling the control object element.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) Embodiments will now be described, by way of example only, with reference to the accompanying drawings which are meant to be exemplary, not limiting, and wherein like elements are numbered alike in several Figures, in which:
(2)
(3)
(4)
(5)
(6)
(7)
DETAILED DESCRIPTION
(8) A preferred embodiment of the present invention will be described below with reference to the accompanying drawings.
(9) A servo control system in this embodiment includes a motor 2 which is mechanically connected with an operation object 4 to drive the operation object 4 and a servo control device 1 structured to control the motor 2. In this embodiment, the servo control system is described in which the motor 2 is controlled by the servo control device 1. However, the control object is not limited to a motor and, for example, a robot may be used as the control object. The motor 2 is, as an example, an AC servomotor or a DC servomotor, which drives the operation object 4 which is a load. The motor 2 is attached with a position detection mechanism 3 such as an encoder which is structured to detect a rotation position of the motor 2. The servo control device 1 executes control by a closed-loop system based on a position command, which is given from the outside, and a detected signal from the position detection mechanism 3 and drives the motor 2.
(10)
(11) An operation to be executed by the servo control device 1 is to control driving of the motor 2 so that a rotation position of the motor 2, in other words, a detected position detected by the position detection mechanism 3 becomes y(k) for a position command
ŷ(k)
which is inputted. In the servo control device 1, the detected position is negatively fed back to a summing point 11 to which the position command is inputted, and a position deviation e(k) is calculated in the summing point 11 according to the following expression (1), and the position deviation e(k) is given to a summing point 12.
e(k)=ŷ(k)−y(k) (1)
(12) An output of a lowpass filter 21 described below is negatively fed back to the summing point 12, and a calculation subtracting the output of the lowpass filter 21 from the position deviation e(k) is executed. The calculation result in the summing point 12 is given to a PI control part 13 which is a PI control means and whose transfer function is expressed by F.sub.a(z), and the PI control part 13 creates a drive command u(k). The drive command u(k) is also commonly referred to as a torque command. However, as long as a command is used for controlling an output of the motor 2, the drive command u(k) is not limited to a torque command. For enhancing a prospect of calculation, a variable δ which is “δ=z−1” is introduced. In this embodiment, a transfer function Fa(z) of the PI control part 13 is expressed by the following expression (2).
F.sub.a(z)=(δ+q.sub.0)/δ (2)
“q.sub.0” is one of integral parameters which characterize the system. The parameter q.sub.0 is a coefficient of a primary low-pass filter defined by Fb(z) in a discrete time system, and a coefficient for determining the cut-off frequency of the filter. When used in the function Fa(z), the parameter q.sub.0 is a coefficient expressing integration performance.
(13) A driver circuit (not shown) which is provided inside the servo control device 1 or provided outside the servo control device 1 drives the motor 2 based on the command u(k). In the block diagram, the command u(k) is inputted to the control object element 15 through a speed control proportional gain element 14 where a speed control proportional gain expressed as “G” is applied. In following descriptions, it is assumed that the transfer function P(z) of the control object element 15 includes a contribution of the driver circuit. Disturbance “d” is also applied to the input to the control object element 15. When model parameters m.sub.0 and r.sub.0 are used, the “G” is expressed by the following expression (3).
G=m.sub.0/r.sub.0 (3)
(14) The value m.sub.0 is a coefficient defined in the position command response characteristic from the position command to the detected position as follows:
(m.sub.0z)/(z.sup.2+(m.sub.1−2)z+(1−m.sub.1+m.sub.0))
The position command response characteristic is a desired model characteristic to be matched. Additionally, this expression is related to the relation □=z.sup.−1.
(15) The value r.sub.0 is a numerator coefficient of the transfer function P(z) in a discrete time system obtained by modeling control object element 15, and expresses a gain of the entire control object.
(16) The servo control device 1 further includes, for controlling the motor 2, a difference element 16 (i.e., difference circuit) in which a time difference of the detected position y(k) is obtained to output as a pseudo-velocity v(k), a first gain element 17 (i.e., first gain circuit) to which the pseudo-velocity v(k) is inputted, a delay element 18 (i.e., delay circuit) to which the pseudo-velocity v(k) is inputted, a second gain element 19 (i.e., second gain circuit) to which an output of the delay element 18 is inputted, a summing point 20 (i.e., summing circuit) in which an output of the first gain element 17 and an output of the second gain element 19 are summed, and a lowpass filter 21 to which a summed result of the summing point 20 is inputted. The difference element 16, the delay element 18, the first gain element 17 and the second gain element 19 respectively correspond to a difference means, a delay means, a first gain means and a second gain means. As described above, an output of the lowpass filter 21 is negatively fed back to the summing point 12, and a path from an output of the difference element 16 to the summing point 12 through the lowpass filter 21 is a velocity feedback path. In this embodiment, a transfer function of the difference element 16 is expressed as δ/z, and the delay element 18 is expressed as z.sup.−1. Further, the transfer function H.sub.1 of the first gain element 17 and the transfer function H.sub.2 of the second gain element 18 are respectively expressed as the following expressions (4) and (5), and the transfer function F.sub.b(z) of the lowpass filter 21 is expressed as the following expression (6).
H.sub.1=−(p.sub.1−m.sub.1+m.sub.0−q.sub.0)/(m.sub.0q.sub.0) (4),
H.sub.2={(m.sub.1−m.sub.0)/m.sub.0}−H.sub.1 (5),
F.sub.b(z)=q.sub.0z/(δ+q.sub.0) (6).
Here, p.sub.1 and m.sub.1 are also model parameters.
(17) The parameter p.sub.1 is a coefficient of a denominator polynomial of the transfer function P(z) in a discrete time system obtained by modeling the control object element 15, and a coefficient defined by the characteristic polynomial of the control object P(z): z.sup.2+(p.sub.1−2)z+(1−p.sub.1). This is a coefficient regarding the frequency characteristic (pole of the transfer function) of the entire control object.
(18) The parameter m.sub.1 is a coefficient defined by the desired model characteristic similarly to the parameter m.sub.0. Two poles in the transfer function of the desired position command frequency response characteristic to be matched are determined by the combination of {m.sub.0, m.sub.1). In order to set the input and output gain as “1:1”, the numerator is set as “m.sub.0”.
(19) Next, the control object element 15 in this embodiment will be described below. When considered as a transfer function in a continuous time system using Laplace transform, in a case that the sum of inertia of the motor 2 and inertia of the operation object 4 is expressed as J, a parameter regarding viscosity of the motor 2 and the operation object 4 is expressed as c, and a gain is expressed as g, the control object element 15 comprised of the motor 2 including the driver circuit and the operation object 4 can be commonly modeled with g/(Js.sup.2+cs) and may be further modeled with K/(s.sup.2+λs). This may be further simplified with λ=0. In this embodiment, digital control is performed by using a microprocessor or the like and thus K/(s.sup.2+λs) is converted into a discrete time model to obtain (b.sub.1z+b.sub.0)/(z.sup.2+a.sub.1z+a.sub.0). This is further approximated to (r.sub.0z)/(δ.sup.2+p.sub.1δ). After all, in this embodiment, the control object element 15 is modeled so that P(z) of the transfer function is expressed as the following expression (7).
P(z)=r.sub.0z/(δ.sup.2+p.sub.1δ) (7)
(20) Next, the servo control system in this embodiment will be further described in detail below while comparing with a common servo control system in a prior art.
F.sub.b(z)=h.sub.0z/(δ+h.sub.0) (8)
(21) As understood by comparing
(22) When the transfer function P(z) of the control object element 15 is expressed by the expression (7), the following expressions (9) and (10) are obtained from the block diagram shown in
y(k)=P(z)Gu(k) (9)
v(k)=(δ/z)y(k) (10)
(23) The following expression (11) is obtained from the expressions (9) and (10) and the expression (3).
(24)
(25) When an input of the lowpass filter 21 is expressed as w(k), the following expression (12) is obviously satisfied.
(26)
Further, the following expression (13) is satisfied regarding u(k) which is an output of the PI control part 13.
u(k)=F.sub.a(z){e(k)−F.sub.b(z)w(k)} (13)
(27) Utilizing the relationship of the following expression (14) between F.sub.a(z) and F.sub.b(z), the expressions (2), (8) and (12) are assigned to the expression (13) and then, when the expressions (4) through (6) are further assigned, the following expression (15) is obtained. As a result, the following expression (16) in which u(k) is expressed by e(k) is obtained.
(28)
(29) When the expression (16) is assigned to the expression (11), the following expression (17) is obtained, and the following expression (18) is obtained by applying the expression (10) and the expression (1) to the expression (17).
(30)
(31) When the expression (18) is arranged, the following expression (19) is obtained.
(32)
(33) The expression (19) indicates that, in the servo control system shown in
Other Embodiments
(34) Next, other embodiments in accordance with the present invention will be described below. A structure of PI control shown in
(35)
(36) This indicates that the structure shown in
(37) In the system shown in
(38) The servo control devices 1 in the respective embodiments described above are operated in a discrete time system. Therefore, the respective elements of the summing points 11, 12 and 22, the PI control part 13, the speed control proportional gain element 14, the difference element 16, the first gain element 17, the delay elements 18 and 24, the second gain element 19, the lowpass filter 21 and the limiter 23 may be structured to be individual digital circuits which are operated according to appropriate clocks. However, the servo control device 1 in each of the embodiments can be realized by using a computer such as a microprocessor and by making the computer execute a computer program (software) for realizing the functions of the respective elements and executing their operations. Therefore, the scope of the invention embraces a computer realizing the servo control device 1 by executing on the computer such as a microprocessor.
(39) While the description above refers to particular embodiments of the present invention, it will be understood that many modifications may be made without departing from the spirit thereof. The accompanying claims are intended to cover such modifications as would fall within the true scope and spirit of the present invention.
(40) The presently disclosed embodiments are therefore to be considered in all respects as illustrative and not restrictive, the scope of the invention being indicated by the appended claims, rather than the foregoing description, and all changes which come within the meaning and range of equivalency of the claims are therefore intended to be embraced therein.