This application claims priority to Japanese Patent Application No. 2015-235248 filed Dec. 1, 2015, the entire contents of which are incorporated herein by reference.
The present invention relates to a controller for outputting a command value and controlling a control target based on the command value, and performing hybrid control combining velocity and force control. In particular, the present invention relates to a controller and a control method for controlling the velocity and the force to have a predetermined relationship between them in a system in which the viscous drag varies depending on velocity.
Impedance control is a technique for controlling positions and forces. Impedance control for machines is to control their positions and forces to control mechanical impedance (inertia, an attenuation coefficient, and stiffness) in response to an external force applied to a control target to achieve intended motions. Patent Literature 1 describes a parameter adjustment apparatus that adjusts parameters used in impedance control based on information provided from a force sensor mounted on an end effector of a robot.
Patent Literature 1: Japanese Unexamined Patent Application Publication No. 2011-88225 (published on May 6, 2011)
An extrusion molding machine controls a molded object to be extruded with a constant force at a constant velocity. An object to be extruded receives a viscous drag F written by the formula F=DV+U, where F is the viscous drag, D is a viscous drag coefficient, V is a velocity, and U is an offset. In this manner, the viscous drag is written by the relational expression of the velocity and the force. When the viscous drag changes as the temperature or another condition changes, the control cannot be performed with a constant force at a constant velocity.
A control system used for the extrusion molding machine or other machines typically includes a servomotor, and a controller for controlling the servomotor by providing a command value to the servomotor. In this system, the controller outputs a position or velocity command value to the servomotor to control the position or the velocity of a control target, which is driven by the servomotor. The controller also outputs a torque command value to the servomotor to control the servomotor to be driven with an intended torque. As described above, this control system cannot control the velocity and the force in parallel.
One or more aspects of the present invention are directed to a controller and a control method for controlling the velocity and the force of a control target to have a predetermined relationship between them, independently of any changes in the velocity at which the control target is driven in response to a velocity command value and any changes in an external force from the control target.
In response to the above issue, a controller according to one aspect of the present invention controls a control target by periodically outputting a command value to the control target using a command target value calculated from a command pattern for driving the control target and a feedback value provided from the control target relative to the command target value. The control target is driven to generate a predetermined viscous force as a reaction force. The controller includes a correction operation unit that obtains a control physical quantity different from the command value, calculates a correction command value based on a relationship between an error of the obtained control physical quantity from a target value of the control physical quantity and an error of the feedback value from the command target value, and outputs the correction command value to the control target.
In the controller according to another aspect of the present invention, the command value is a velocity command value, and the control physical quantity is a force, and the correction operation unit calculates the correction command value using the following relational expression for velocity impedance control eliminating a spring constant: Vc=Vnow+{Dd1(Vd−Vnow)+Md1(Fnow−Fd)} Δt, where Vd is a target velocity value, Vnow is a feedback velocity value, Fd is a target force value, Fnow is a feedback force value, Dd1 is a weight coefficient, and Md1 is a weight coefficient.
This structure appropriately controls the velocity and the force, while eliminating a spring constant showing a reaction force against a positional deviation amount.
The controller according to another aspect of the present invention further includes a storage unit that stores an upper limit and a lower limit of the correction command value. When the calculated correction command value is not within a range defined by the upper limit and the lower limit, the correction operation unit outputs the upper limit or the lower limit as the correction command value.
This structure allows calculation of a corrected velocity command value based on its maximum and minimum values.
In the controller according to another aspect of the present invention, a ratio of the weight coefficient Dd1 and the weight coefficient Md1 is changed for every control cycle of the controller in every period for periodically outputting the command value, and a corrected velocity command value is output based on the changed ratio.
One or more embodiments of the present invention allow control of the velocity and the force of a control target to have a predetermined relationship between them, independently of any changes in the velocity at which the control target is driven in response to a velocity command value and any changes in an external force from the control target.
A controller according to embodiments of the present invention will now be described with reference to the drawings. The invention is not limited to these embodiments.
Overall System Configuration
Referring to
The controller 100 is typically a programmable logic controller (PLC). The controller 100 calculates a velocity command value in every control period based on a target control profile set by the user. The controller 100 further includes an operation unit 130 (refer to
The driver 200 typically includes servo drivers 19 and 29 (refer to
Hardware Configuration of Controller 100
The hardware configuration of the controller 100 will now be described.
The processor 102 reads a system program 110 and a user program 112, which are stored in the flash memory 108, and expands and executes them in the main memory 106 to control the control target. The system program 110 contains instruction codes for providing the basic functions of the controller 100, such as data input and output and execution timing control. In the present embodiment, the system program 110 includes library programs 110A. The library programs 110A are general-purpose processing programs stored in a reusable manner, and are called or invoked as appropriate when the user program 112 is executed. In other words, the library programs 110A are used when the controller 100 executes a program.
The user program 112 is designed as appropriate for the control target. The user program 112 includes sequence programs 112A for executing sequence control and motion programs 112B for executing motion control. The sequence programs 112A and the motion programs 112B are executed when the library programs 110A are called as appropriate.
The chipset 104 controls these components to implement the entire processing performed by the controller 100.
The internal bus controller 122 is an interface for data communication with an I/O unit 126, which is connected to the controller 100 with an internal bus. The fieldbus controller 124 is an interface for data communication with an I/O unit 128, which is connected to the controller 100 with a fieldbus (not shown). The internal bus controller 122 and the fieldbus controller 124 each obtain a state value input into the corresponding I/O units 126 and 128, and output, as a command value, the results of operation performed by the processor 102 from the corresponding I/O units 126 and 128.
The external network controller 116 controls data communication performed via a wired or wireless network. The memory card interface 118 includes a removable memory card 120, from which data can be read and to which data is written.
Some or all of the functions provided by the controller 100 executing programs may be implemented using a dedicated hardware circuit.
Control Algorithm for Velocity and Force
The inventors have noticed one technique associated with the velocity and the force to control an error between a target velocity value and a velocity command value or an error between a target velocity value and a current velocity value to have a predetermined ratio to an error between a target force value and a current force value. The principle of controlling the velocity and the force based on the ratio of errors for the velocity and the force will be described.
The general formula for impedance control using a velocity command is given below.
In this formula, Kd is a spring constant, Dd is a viscosity coefficient, Md is a mass, xd is a target position, vd is a target velocity, and Fd is a target force.
Formula 1 can be transformed into the formula below.
Vc=∫Kd1(xd−xnow)+Dd1(Vd−Vnow)Md1(Fnow−Fd)dt Formula 2
When the spring constant is 0 or when Kd1=0 in this formula, Formula 3 below is obtained.
Vc=∫Dd1(Vd−Vnow)+Md1(Fnow−Fd)dt Formula 3
Formula 3 is discretized with Euler's approximation to obtain Formula 4 below.
Vc=Vnow+{Dd1(Vd−Vnow)+Md1(Fnow−Fd)}Δt Formula 4
Using Formula 4, the velocity command value is calculated using the current velocity value and the current force value. The velocity command value includes the term representing the force error value, and can be used to calculate the corrected velocity command value using the feedback force value.
In a steady state, Vc≈Vnow. The formula below is thus obtained.
The formula is −Dd1(Vd−Vnow)=Md1(Fnow−Fd). Thus, Dd1(Vd−Vnow)=Md1(Fd−Fnow).
When the virtual spring constant is 0 in the general formula for impedance control, the ratio of a virtual viscosity coefficient to a virtual damper coefficient can be set to control a velocity error between a target velocity value and a current velocity value and a force error between a target force value and a current force value to have a predetermined relationship between them.
Control Method
In step S1, the command value generation unit 1321 included in the operation unit 130 reads a target command pattern and the ratio of the velocity error to the force error from the memory. The ratio of the velocity error to the force error may be set in advance, or may be set by the user through a user interface of, for example, a controller support apparatus.
In step S2, the command value generation unit 1321 reads a maximum value and a minimum value of a permissible velocity from the memory.
In step S3, the command value generation unit 1321 and the correction operation unit 1322 read, as feedback values, the current values of the velocity and the force of the control target that is being driven. The current values of the velocity and the force, the ratio of the velocity error to the force error read in step S1, and the target command pattern are used to calculate the velocity command value using Formula 4 above.
In step S4, the correction operation unit 1322 included in the operation unit 130 determines whether the corrected velocity command value calculated in step S3 falls within the range defined by the permissible maximum value and the permissible minimum value read in step S2. When the corrected velocity command value is within the permissible range, the correction operation unit 1322 outputs the corrected velocity command value calculated in step S3 to the servo driver 19 (step S5).
When the corrected velocity command value calculated in step S3 does not fall within the permissible range, the correction operation unit 1322 outputs the permissible maximum value or the permissible minimum value as a corrected velocity command value to the servo driver 19 (refer to
In step S6, the operation unit 130 determines whether the control target has reached a target position. When the control target has reached the target position, the operation unit 130 ends the process.
Simulation Results
With reference to
Table 1 shows the results of errors with velocity control, torque control, and impedance control.
F=−3×V+6(0<=t<=20) and F=−2×V−3(20<=t) Condition: Viscous Drag F
Referring to
Table 2 and
Referring to Table 2, when the lower velocity limit is set at 9.35, the lower velocity limit of 9.35 is output.
Referring to
Modifications of Impedance Control
Although the technique described in the above embodiment yields the corrected velocity command value with the predetermined ratio of the velocity error and the force error, the controller may intend to control an extruding machine or other machines using a maximum force value and a minimum force value in addition to the maximum velocity value and the minimum velocity value described above.
Although the corrected velocity command is calculated based on the ratio of a fixed velocity error and a fixed force error in the embodiment described above, the corrected velocity command in this modification is calculated using a different ratio of velocity and force errors in every control period in the example described below.
The formula for the velocity command impedance control is written as Formula 4 described above.
Vc=Vnow+{Dd1(Vd−Vnow)+Md1(Fnow−Fd)}Δt Formula 4
In one or more embodiments of the present invention, the force error has less effect as the value of Md1 decreases, and the velocity error has less effect as the value of Dd1 decreases.
Based on this characteristic, the weight coefficient Dd1 for the velocity is replaced with the coefficient Dd1*, which changes sequentially under the conditions below. The coefficient Dd1* may be calculated using the formula below.
Under this setting in this formula, the value of Dd1* is very small when Fnow≈Fmin or Fnow≈Fmax. The velocity error has no effect, and the force is more likely to follow its target value. In a steady state, the force will fall within the range defined by its upper limit and its lower limit.
Formula 4 is transformed using Formula 5 to obtain Formula 6 for velocity impedance control.
In this formula, when Fnow approaches Fmax, Fmax−Fnow≈0.
The above formula is obtained.
Formula 7 for impedance control for velocity is thus obtained as follows.
Vc=Vnow+{Md1(Fnow−Fd)}Δt Formula 7
The corrected velocity command value obtained using this formula can be used to control the force to approach its target value Fd. The same applies to the force when Fnow approaches Fmin. The force is thus also controlled to approach the target value Fd.
As shown in
This allows the corrected velocity command value to approach a value within the ranges of the maximum value and the minimum value of both the velocity and the force. The corrected velocity command value is used to control a machine to control its velocity and force between the maximum and minimum values.
Library Programs and User Program
The structure of the controller according to the present embodiment for calculating a corrected velocity command value using impedance control will now be described. In one embodiment, library programs designed for calculating a corrected velocity command value resulting from impedance control are installed preliminary in the controller. The user of the controller can generate codes to read the library programs using a controller support apparatus (not shown). Such library programs are installed preliminary by the manufacturer of the controller or by a third party, and are used to create a user program for calculating a corrected velocity command value with impedance control in a short time. The user program is executed to calculate a corrected velocity command value typically with impedance control for a control target.
Referring to
The impedance control function blocks described above and the library programs that are executed to implement these functional blocks allow creation of a program for controlling the ratio of the velocity error and the force error to have a predetermined relationship between them through impedance control without increasing the number of man-hours.
Application Examples
The controller according to the embodiments of the present invention is usable in applications for machines for controlling the velocity and the force at a predetermined ratio. For example, the controller can control a molding machine that may change its molding target from an object with high viscosity to an object with low viscosity. The controller sets the upper and lower limits of the force to be applied on the molding target to control the velocity and the force.
The controller according to the embodiments of the present invention is also usable for a winding machine. The controller sets the winding velocity within a predetermined range defined by a maximum velocity value and a minimum velocity value and the upper limit of the force to be applied on the winding target to control the winding machine at the velocity falling within the predetermined range with the force not exceeding its upper limit.
Although controllers known in the art reset control parameters associated with velocity and force commands for any changes in the processing targets or conditions, the controller according to the embodiments of the present invention eliminate such resetting of parameters.
Number | Date | Country | Kind |
---|---|---|---|
2015-235248 | Dec 2015 | JP | national |
Number | Name | Date | Kind |
---|---|---|---|
5997780 | Ito | Dec 1999 | A |
6704160 | Takakura | Mar 2004 | B2 |
6902386 | Uchiyama | Jun 2005 | B2 |
7757526 | Iwashita | Jul 2010 | B2 |
9658608 | Nagaoka | May 2017 | B2 |
20100274504 | Takahashi | Oct 2010 | A1 |
20110093120 | Ando et al. | Apr 2011 | A1 |
20160026170 | Etou | Jan 2016 | A1 |
20160183845 | Wang et al. | Jun 2016 | A1 |
20170153628 | Koga | Jun 2017 | A1 |
20170199510 | Fujita | Jul 2017 | A1 |
Number | Date | Country |
---|---|---|
101769818 | Jul 2010 | CN |
102553942 | Jul 2012 | CN |
103845064 | Jun 2014 | CN |
61203727 | Sep 1986 | JP |
S62-174804 | Jul 1987 | JP |
H5-150836 | Jun 1993 | JP |
H8-126939 | May 1996 | JP |
09237112 | Sep 1997 | JP |
2011-088225 | May 2011 | JP |
Entry |
---|
The Office action dated Aug. 28, 2018 in a counterpart Japanese patent application. |
The Office action dated Sep. 3, 2018 in a counterpart Chinese patent application. |
The Extended European search report dated Mar. 29, 2017 in the counterpart European patent application. |
Chuanzhi et al., A Velocity-Based Impedance Control System for a Low Impact Docking Mechanism (LIDM), Sensors, Dec. 3 2014, pp. 22998-23016, vol. 14, No. 12, doi: 10.3390/s141222998, ISSN 1424-8220. |
Kobayashi et al., Robust Control of Pneumatic Actuators Based on Dynamic Impedance Matching, Oct. 22, 1995, pp. 983-987, vol. 2, NY, US. |
Negar Kharmandar et al., Force Impedance Control of a Robot Manipulator Using a Neuro-Fuzzy Controller, 2011 International Conference on Mechatronic Science, Electric Engineering and Computer, Aug. 19-22, 2011, pp. 559-563, Jiliin, China. |
Number | Date | Country | |
---|---|---|---|
20170153634 A1 | Jun 2017 | US |