The present invention relates to an actuator using a fluid cylinder, and a method of controlling the same.
As shown in Japanese Patent Publication No. 2003-311667, an electric motor such as a servomotor is conventionally used as an actuator for moving a joint of a robot. It is because motors are relatively readily available. However, the use of a motor is likely to make the robot larger and heavier. A fluid cylinder such as an air cylinder is lighter and more compact in size than a motor. In addition, the fluid cylinder is simple in structure and maintenance thereof is easy. The motor having such advantages is useful as an actuator for a robot.
What most hampers the application of a fluid cylinder such as an air cylinder is difficulty in bringing rigidity into full performance with which a piston becomes hard to move at an arbitrary position. This may be primarily because, unlike the motor, the fluid cylinder is low in responsiveness to force generation, thereby being unable to promptly generate a counteracting force against an external force in order to maintain the position of the piston. To solve this problem, a friction brake, a latch, and the like may be employed. However, it will be more reasonable to employ a motor alone. Therefore, what is needed is to attain the rigidity with as simple a mechanism as possible. However, technology which meets such demand has not been proposed yet.
It is an object of the present invention to provide an actuator using a fluid cylinder that gives rigidity to the fluid cylinder such as an air cylinder with a simple configuration, and a method of controlling the same.
It is another object of the present invention to provide an actuator using a fluid cylinder in which rigidity adjustment is easy.
It is a further object of the present invention to provide an actuator using a fluid cylinder in which rigidity adjustment is possible with a simple structure and component configuration.
The present invention is directed to an actuator using a fluid cylinder that has two chambers. In the present invention, an opening of a valve of a discharge valve mechanism for the chamber is set so as to be in inverse proportion to a target pressure for the chamber. If the opening for the discharge valve mechanism is set in this manner, association may be found between the target pressure and a desired rigidity. Thus, rigidity adjustment becomes possible with a few control parameters.
More specifically, the actuator using a fluid cylinder of the present invention comprises a fluid cylinder including a cylinder chamber and a piston slidably disposed in the cylinder chamber so as to partition the cylinder chamber into a first chamber and a second chamber. Here, the fluid cylinder refers to a cylinder, which is activated by means of a fluid pressure as its driving source, such as an air cylinder and an oil cylinder. The actuator using a fluid cylinder of the present invention further comprises a first choke valve device disposed between a fluid pressure source and the first chamber to adjust a fluid pressure in the first chamber, and a second choke valve device disposed between the fluid pressure source and the second chamber to adjust a fluid pressure in the second chamber. Here, the fluid pressure source may be separately arranged for each of the first and second choke valve devices, or one common fluid pressure source may be provided to the first and second choke valve devices. The first choke valve device and the second choke valve device respectively include: a remotely-controllable supply valve mechanism which allows a fluid to flow in an incoming direction from the fluid pressure source to the corresponding chamber; a remotely-controllable discharge valve mechanism which allows the fluid to flow in an outgoing direction from the chamber to the atmosphere or a low pressure source; and a valve mechanism control device which outputs a control command to remotely control opening and closing of the supply valve mechanism and the discharge valve mechanism, and a valve opening setting command to set the opening of a valve of the discharge valve mechanism (namely, to determine ease of fluid discharge). It is needless to say that the above-mentioned low pressure source may include the fluid pressure source depending on circumstances. Specifically, the valve mechanism control device is configured to output a control command to remotely control opening and closing of the supply valve mechanism and the discharge valve mechanism, and a valve opening setting command to set the opening (namely, ease of fluid discharge) for the discharge valve mechanism.
The actuator using a fluid cylinder of the present invention further comprises pressure measurement means for measuring an actual pressure in the chamber.
The supply valve mechanism and the discharge valve mechanism which are provided in the choke valve device may be respectively constituted as a separate structure, or a composite valve mechanism including the supply valve mechanism and the discharge valve mechanism both disposed in one structure may be employed.
In the present invention, the opening of the valve of the discharge valve mechanism is set in accordance with the valve opening setting command. The valve mechanism control device is configured to set the opening of the valve so as to be in inverse proportion to the target pressure of the chamber in which the fluid pressure is adjusted by the choke valve device. Namely, the valve of the supply valve mechanism is opened when the target pressure is higher than the actual pressure. Alternatively, the valve of the discharge valve mechanism may be closed. The valve mechanism control device is also configured to close the valve of the supply valve mechanism and set the opening of the valve of the discharge valve mechanism so as to be in inverse proportion to the magnitude of the target pressure when the target pressure is lower than the actual pressure. When the actual pressure reaches the target pressure, the valve of the discharge valve mechanism is closed.
The valve mechanism control device is also configured to output a valve opening setting command and a control command as described below. The valve mechanism control device outputs a valve opening setting command to set the opening of the valve so as to be in inverse proportion to the target pressure in the chamber in which the fluid pressure is adjusted by the choke valve device. In response to the valve opening setting command, the opening of the valve of the discharge valve mechanism is determined in accordance with the target pressure at first. A control command to open the valve of the supply valve mechanism is outputted when the target pressure is higher than the actual pressure. A control command to close the valve of the discharge valve mechanism is outputted when the actual pressure reaches the target pressure. When the target pressure is lower than the actual pressure, a control command to close the valve of the supply valve mechanism and to open the valve of the discharge valve mechanism is outputted. When the actual pressure reaches the target pressure, a control command to close the valve of the discharge valve mechanism is outputted.
If an incoming or outgoing flow of the fluid to/from the fluid cylinder is stopped, or if a flow path for the fluid connected to the fluid cylinder is narrowed, a passive resistance which acts to resist piston movement is generated by repulsion (spring effect) of the compressed fluid or by the fluid-flow resistance (the damper effect) of the incoming or outgoing fluid. The present invention pays attention to the generation of this passive resistance and utilizes the resistance as rigidity of the fluid cylinder. Namely, the resistance against piston movement is effectively generated by appropriately choking the flow of the fluid in the flow path through which the fluid discharged from the first chamber and the second chamber of the fluid cylinder flows. Rigidity is thereby given to the fluid cylinder using the resistance (the piston is stopped in a specified position and becomes hard to move by an external force).
For example, in order to provide rigidity to the piston at a specified position after moving the piston to a certain moving direction, the following steps are carried out. The first step is to increase the amount of the fluid (fluid pressure) which is supplied from the fluid pressure source of the choke valve device disposed for the chamber of which the internal pressure is required to be raised when moving the piston. The next step is to give the fluid cylinder rigidity by appropriately choking the fluid flow with the choke valve device through which the fluid flows after being discharged from the chamber into which the piston is moving. Choking the fluid flow is accomplished by adjusting the opening of the valve of the discharge valve mechanism disposed for the corresponding choke valve device. In the present invention, the valve opening of the discharge valve mechanism is determined based on the target pressure of the fluid in the intended chamber. Specifically, the valve mechanism control device outputs a valve opening setting command to set the opening of the valve of the discharge valve mechanism so as to be in inverse proportion to the target pressure in the chamber in which the fluid pressure is adjusted by the choke valve device. Namely, the opening of the valve of the discharge valve mechanism is set small when the target pressure is high, and the opening thereof is set large when the target pressure is low. This comes from a presumption that a high target pressure is aimed at attaining high rigidity while a low target pressure is aimed at attaining low rigidity. The smaller the opening of the valve of the discharge valve mechanism is, the more slowly the actual pressure in the chamber decreases, thereby letting the actual pressure reach the target pressure while maintaining the high rigidity. When the opening of the valve of the discharge valve mechanism is set large, the actual pressure in the chamber is lowered quickly, thereby promptly reducing the actual pressure in the chamber down to the target pressure necessary for attaining low rigidity.
Increasing or decreasing the opening of the valve of the discharge valve mechanism is carried out in a relative manner. For example, when there are only two levels, large and small, for the opening of the valve of the discharge valve mechanism to be used, decreasing the opening means selecting the small opening and increasing the opening means selecting the large opening. When there are a plurality of levels for the opening of the valve of the discharge valve mechanism, the target pressure may be divided into the same number of levels as the number of levels for valve opening, and levels of valve opening may be predetermined in a one-for-one relationship between the target pressure and the valve opening. In this manner, selection of the opening of the valve of the discharge valve mechanism will become quite simple.
When the valve opening for the discharge valve mechanism can be selected incrementally or decrementally from a plurality of levels, the discharge valve mechanism may include: two or more kinds of open/close valves that are connected in parallel to each other and respectively have a discharge path of a different cross-sectional area; and valve selection control means for selecting a combination of the open/close valves from among the two or more kinds of open/close valves in accordance with the valve opening setting command so that a summation of the cross-sectional areas of the discharge paths of the selected valves may be the closest to a target cross-sectional area, and opening the selected open/close valves when the control command is inputted. With such discharge valve mechanism, multiple levels of valve opening may be arranged merely by selecting from among the two or more kinds of open/close valves. As the two or more kinds of open/close valves, those valves may be used, each having a discharge path of a cross-sectional area calculated by multiplying the smallest cross-sectional area by the nth power of base number a (where n=0, 1, 2, 3, . . . , and a>1). Namely, the two or more kinds of open/close valves respectively have a discharge path of a different cross-sectional area. The discharge path of one of the open/close valves has the smallest cross-sectional area S among the two or more kinds of open/close valves. The discharge paths of the remaining open/close valves respectively have a cross-sectional area calculated by multiplying the smallest cross-sectional area S by the nth power of base number a larger than one (that is, an*S where n=1, 2, 3, . . . ). In this manner, the levels for valve opening may be maximized with respect to the number of the number of disposed open/close valves.
When the base number a is a value close to one, increments of the valve opening level will be almost constant over the whole range. The larger the base number a is, the finer increments of the valve opening level will be obtained in a local range, and the rougher increments of the valve opening level will be obtained in other local ranges. The value of the base number may arbitrarily be determined according to how the actuator should be controlled. For example, when the smallest cross-sectional area is very small, the base number should be set close to one. When the smallest cross-sectional area is large enough, the base number may be set to a large value such as 2 and 3. This is because a slight change of the cross-sectional area brings about a substantial change in the fluid resistance in the flow path when the smallest cross-sectional area is very small. When the smallest cross-sectional area is large enough, a change of the cross-sectional area hardly brings about a change in the fluid resistance in the flow path. In this case, it is advisable to arrange valves M each having a greatly different cross-sectional area to efficiently bring about a difference in the fluid resistance in the flow path.
The discharge valve mechanism may include: a valve equipped with an opening adjustment mechanism capable of incrementally or decrementally adjusting the opening of the valve; an open/close valve which is disposed in series with the valve equipped with the opening adjustment mechanism is controlled by the vale equipped with the opening adjustment mechanism for opening and closing; and valve control means for setting the opening of the valve equipped with the opening adjustment mechanism in accordance with the valve opening setting command and for controlling the open/close valve in accordance with the control command.
More specifically, the valve-mechanism control device may be configured to output the valve opening setting command to set the opening of the valve of the discharge valve mechanism in the following manner. First, a reference pressure is identified with respect to the target pressure and a reference opening is identified with respect to the opening of the valve of the discharge valve mechanism. When the target pressure is higher than the actual pressure, the opening of the valve of the discharge valve mechanism is set to zero. When the target pressure is lower than the actual pressure and higher than the reference pressure, the opening of the valve of the discharge valve mechanism is set to be smaller than the reference opening. When the target pressure is lower than both of the actual pressure and the reference pressure, the opening of the valve of the discharge valve mechanism is set to be larger than the reference opening. Further, when the target pressure is zero, the opening of the valve of the discharge valve mechanism is maximized. In this manner, the actuator may practically be controlled even when there are few predetermined levels for valve opening.
For assured controlling, the valve mechanism control device may preferably be configured to output the valve opening setting command to the discharge valve mechanism before outputting the control command to instruct the discharge valve mechanism to open/close the valve.
In a control method of the actuator according to the present invention, the target pressure is compared with the actual pressure in the chamber in which fluid is supplied through the supply valve mechanism. Wherever the target pressure is higher than, or equal to, or lower than the actual pressure, the opening of the valve of the discharge valve mechanism is set so as to be in inverse proportion to the target pressure of the chamber in which the fluid pressure is adjusted. When the target pressure is higher than the actual pressure, a control command to open the valve is outputted to the supply valve mechanism after the opening of the valve of the discharge valve mechanism has been set to zero. When the target pressure is lower than the actual pressure and higher than the reference pressure, a control command to open the valve is outputted to the discharge valve mechanism, after the opening of the valve of the discharge valve mechanism has been set to be smaller than the reference opening. When the target pressure is lower than both of the actual pressure and the reference pressure, a control command to open the valve is outputted to the discharge valve mechanism, and a control command to close the valve is outputted to the supply valve mechanism, after the opening of the valve of the discharge valve mechanism has been set to be larger than the reference opening. Further, when the target pressure is zero, the control command to open the valve is outputted to the discharge valve mechanism and the control command to close the valve is outputted to the supply valve mechanism, after a valve opening setting command to maximize the opening of the valve of the discharge valve mechanism has been outputted. Then, when the actual pressure reaches the target pressure, the control command to close the valves of the supply valve mechanism and the discharge valve mechanism is outputted. In this manner, desired high or low rigidity may reliably be provided to the fluid cylinder with a simple configuration.
Hereafter, embodiments of the present invention are described with reference to the drawings.
The first choke valve device 3 is disposed between a fluid pressure source, not shown, and the first chamber 9 to adjust a flow of the fluid flowing into the first chamber 9. The fluid pressure source is configured to receive the fluid flowing out of the first chamber 9 when a pressure in the first chamber 9 becomes larger than the pressure of the fluid supplied from the fluid pressure source. As well, the second choke valve device 5 is disposed between the fluid pressure source, not shown, and the second chamber 11 to adjust the flow of the fluid flowing into the second chamber 11. The second choke valve device 5 is shown as a simple block diagram in which detailed description is omitted since the second choke valve device has the same configuration and functionality as the first choke valve device 3. Hereinafter, the configuration of the first choke valve device 3 is explained and explanation about the second choke valve device 5 is omitted.
In the embodiment of the present invention, the first and second choke valve devices 3 and 5 respectively have a separate fluid pressure sources. However, one common fluid pressure source may be provided for the first and second choke valve devices 3 and 5.
As shown in
The valve mechanism control device 21 also outputs to the discharge valve mechanism 15 a valve opening setting command that sets an opening of the valve. The supply valve mechanism 13 opens and closes valves with an actuator 20 activated in accordance with a control command from the valve mechanism control device 21. The discharge valve mechanism 15 includes: a valve 25 equipped with an opening adjustment mechanism capable of incrementally or decrementally adjusting the opening of the valve; an open/close valve 27 which is disposed in series with the valve 25 equipped with the opening adjustment mechanism and is controlled for opening and closing; a continuously variable actuator 29 for setting the opening of the valve 25 equipped with the opening adjustment mechanism in accordance with the valve opening setting command; valve position detection means 31 for detecting a position of the valve; and an actuator 33 which controls opening and closing of the open/close valve 27. The continuously variable actuator 29, the valve position detection means 31, and the actuator 33 constitute valve control means. In order to make variable the opening of the valve 25 equipped with the opening adjustment mechanism, the valve mechanism control device 21 carries out a feedback control for the continuously variable actuator 29 based on an output from the valve position detection means 31. A member designated at a reference numeral 35 is pressure measurement means for measuring an actual pressure in the first chamber 9.
As will be explained later, a flow path of the fluid connected to the fluid cylinder 1 is narrowed or expanded (decreasing or increasing the opening) by setting the opening of the valve 25 equipped with the opening adjustment mechanism of the discharge valve mechanism 15 so as to be in inverse proportion to the target pressure indicated by the controller 23. As a result, repulsion (spring effect) of the compressed fluid and fluid-flow resistance (the damper effect) of the incoming/outgoing fluids are generated to produce a passive resistance which acts to hamper the movement of the piston 12. The embodiment of the present invention utilizes the resistance as the rigidity of the fluid cylinder. Namely, the resistance hampering the movement of the piston is effectively generated in the flow path through which the fluid discharged from the first chamber 9 and the second chamber 11 in the fluid cylinder 1 flows, by appropriately choking the flow of the discharged fluid. The resistance may provide the fluid cylinder 1 with high rigidity (a state in which the piston 12 is stopped in a specified position and becomes hard to move by an external force), and low rigidity (a state in which the piston 12 is stopped in a specified position but can be moved even by a weak external force).
For example, the second choke valve device 5 is activated to move the piston 12 from the second choke valve device 11 to the first chamber 9. Then, in order to provide the rigidity to the fluid cylinder when the piston 12 is stopped in a specified position, the controller 23 indicates the target pressure PD of the first chamber 9 to the valve mechanism control device 21. Next, the amount of supply of the fluid (fluid pressure) flown out of the fluid pressure source disposed for the second choke valve device 5 is increased to raise an internal pressure of the second chamber 11. The opening of the valve 25 of the discharge valve mechanism 15 for the first choke valve device 3, through which the fluid flows out of the first chamber 9 into which the piston 12 is moved, is set so as to be in inverse proportion to the target pressure PD. This setting is carried out by outputting a valve opening setting command to the continuously variable actuator 29 from the valve mechanism control device 21. In the present embodiment, the valve opening setting command is inputted into the continuously variable actuator 29 from the valve mechanism control device 21 before the control command to open the valve is outputted from the valve mechanism control device 21 to the actuator 33 that controls opening and closing of the valve of the open/close valve 27. Therefore, when the control command to open the open/close valve 27 is inputted into the actuator 33 to open the open/close valve 27, the opening of the valve 25 equipped with the opening adjustment mechanism has already been set so as to be in inverse proportion to the target pressure PD.
By referring to a flowchart in
As with the present embodiment, although the discharge valve mechanism 15 includes the valve 25 equipped with an opening adjustment mechanism capable of incrementally or decrementally adjusting the opening of the valve, and the open/close valve 27 which is disposed in series with the valve 25 equipped with an opening adjustment mechanism and is controlled by the valve 25 equipped with an opening adjustment mechanism for opening and closing, the opening of the valve may be set in two levels. For example, when a small opening is required, the opening of the valve 25 equipped with the opening adjustment mechanism may be minimized. When a large opening is required, the opening of the valve 25 equipped with the opening adjustment mechanism may be maximized. Alternatively, the opening of the valve 25 equipped with the opening adjustment mechanism may be set according to the relationship in magnitude of the pressure between the target pressure PD and reference pressure Pr.
In the above-mentioned control method, the same control is also carried out in the second choke valve device 5 with respect to the second chamber 11. The controller 23 may be arranged separately for each of the first choke valve device 3 and the second choke valve device 5.
When the target pressure PD is lower than the actual pressure PR, the control command to open the open/close valve 27 of the discharge valve mechanism 15 is outputted from the valve mechanism control device 21 to actuator 33 to open the open/close valve 27. At this time, the control command to close the valve of the supply valve mechanism 13 is outputted to the actuator 20 from the valve mechanism control device 21, and the valve of the supply valve mechanism 13 is closed. Since the opening of the valve 25 equipped with an opening adjustment mechanism is set in advance in accordance with the magnitude of the target pressure PD, the fluid is discharged from the chamber 9 through the discharge valve mechanism 15 with a valve-choke condition determined by the opening set in advance.
Namely, when the target pressure PD is higher than the reference pressure Pr (when high rigidity is required), the pre-determined, required small opening is set in advance as the opening of the valve 25 equipped with the opening adjustment mechanism. When the target pressure PD is lower than the reference pressure Pr (when low rigidity is required), the pre-determined large opening is set in advance as the opening of the valve 25 equipped with the opening adjustment mechanism. When the actual pressure PR in the chamber 9 reaches the target pressure PD, the control command to close the valve of the open/close valve 27 is outputted to the actuator 33 by the valve mechanism control device 21. In this manner, the actual pressure in the chamber 9 immediately reaches the target pressure PD and high or low rigidity may be attained with certainty.
Incidentally, if the opening of the valve 25 equipped with the opening adjustment mechanism is set further more finely in accordance with the magnitude of the target pressure PD, more precise rigidity may be provided to the cylinder 1.
In the above-mentioned control, a similar control is also performed in the second choke valve device 5 with respect to the second chamber 11. The controller 23 may be arranged separately for each of the first choke valve device 3 and the second choke valve device 5.
With such discharge valve mechanism 115, various levels of openings may be set by selecting from among the two or more kinds of open/close valves. Among the two or more kinds of open/close valves each having a discharge path of a different cross-sectional area, one of the valves has a discharge path of the smallest cross-sectional area S of the two or more kinds of open/close valves. The discharge paths of the remaining open/close valves respectively have a cross-sectional area calculated by multiplying the smallest cross-sectional area by the nth power of the base number a larger than one (that is, an*S where n=1, 2, 3, . . . ). Incidentally, when n is zero, the cross-sectional area is the smallest. In this manner, the maximal opening levels may be defined for the number of the disposed open/close valves.
In the above-mentioned control method, the control is also performed similarly in the second choke valve device 105 with respect to the second chamber 11. The controller 123 may be arranged separately for each of a first choke valve device 103 and a second choke valve device 105.
According to each of the above-mentioned embodiments, desired rigidity may easily be given to the fluid cylinder by setting the opening of the valve of the discharge valve mechanism for the choke valve device so as to be in inverse proportion to the target pressure PD. Accordingly, the actuator of the present embodiment may practically be used as an actuator for driving a control machinery for a robot and the like.
According to the present invention, desired high or low rigidity may reliably be given to a fluid cylinder with a simple configuration.
Number | Date | Country | Kind |
---|---|---|---|
2005-105110 | Mar 2005 | JP | national |
Filing Document | Filing Date | Country | Kind | 371c Date |
---|---|---|---|---|
PCT/JP2006/306968 | 3/31/2006 | WO | 00 | 9/28/2007 |
Publishing Document | Publishing Date | Country | Kind |
---|---|---|---|
WO2006/106985 | 10/12/2006 | WO | A |
Number | Name | Date | Kind |
---|---|---|---|
4518011 | Stoll | May 1985 | A |
5775197 | Kimura | Jul 1998 | A |
6662705 | Huang et al. | Dec 2003 | B2 |
Number | Date | Country |
---|---|---|
2 203 195 | Oct 1988 | GB |
60-116902 | Jun 1985 | JP |
62-088802 | Apr 1987 | JP |
62-118103 | May 1987 | JP |
63-211410 | Sep 1988 | JP |
06-109004 | Apr 1994 | JP |
09-217704 | Aug 1997 | JP |
2003-311667 | Nov 2003 | JP |
02086327 | Oct 2002 | WO |
Number | Date | Country | |
---|---|---|---|
20080271596 A1 | Nov 2008 | US |