PNEUMATIC ACTUATOR CONTROL DEVICE
20230145441 · 2023-05-11
Assignee
Inventors
Cpc classification
F15B2211/6323
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G05B19/416
PHYSICS
F15B2211/87
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/327
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/8636
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B13/044
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/857
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B15/2838
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G05D16/204
PHYSICS
F15B2211/3138
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/6306
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/6309
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B19/005
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/8855
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
F15B2211/632
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
International classification
F15B13/044
MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
G05B19/416
PHYSICS
Abstract
Provided is a pneumatic actuator control device including detectors that are disposed in an air supply passage leading from an air supply source to a solenoid valve or in an air exhaust passage leading from the solenoid valve, and that detect the flow volume or the pressure of the air in the air supply passage, or detect the flow volume or the pressure of the air in the air exhaust passage; and an operational state determination unit that, on the basis of data representing a change in the flow volume or the pressure of the air in the air supply passage, or in the flow volume or the pressure of the air in the air exhaust passage, as detected by the detectors, determines the operational state of a pneumatic actuator connected to the solenoid valve.
Claims
1. A pneumatic actuator controller, comprising: a detector which is arranged in an air supply path from an air supply source to a solenoid valve or an air exhaust path from the solenoid valve and which detects a flow rate or pressure of air in the air supply path or a flow rate or pressure of air in the air exhaust path, and an operation state judgment unit configured to judge an operation state of a pneumatic actuator connected to the solenoid valve based on data indicating change in the flow rate or pressure of air in the air supply path or the flow rate or pressure of the air in the air exhaust path detected by the detector.
2. The pneumatic actuator controller according to claim 1, further comprising a solenoid valve control unit configured to transmit an operation command to the solenoid valve based on the operation state judged by the operation state judgment unit.
3. The pneumatic actuator controller according to claim 2, wherein the detector detects the flow rate of the air in the air supply path or the air exhaust path, and the operation state judgment unit judges that a predetermined operation by the pneumatic actuator has ended at a timing of a fall of a time fluctuation waveform of the flow rate after the solenoid valve control unit has sent the operation command.
4. The pneumatic actuator controller according to claim 2, wherein the detector detects the pressure of the air in the air supply path, and the operation state judgment unit judges that a predetermined operation by the pneumatic actuator has ended at a timing of a rise of a time fluctuation waveform of the pressure after the solenoid valve control unit has sent the operation command.
5. The pneumatic actuator controller according to claim 2, wherein the detector detects the pressure of the air in the air exhaust path, and the operation state judgment unit judges that a predetermined operation by the pneumatic actuator has ended at a timing of a fall of a time fluctuation waveform of the pressure after the solenoid valve control unit has sent the operation command.
6. The pneumatic actuator controller according to claim 3, wherein the solenoid valve control unit transmits a subsequent operation command to the pneumatic actuator on a condition of completion of the predetermined operation of the pneumatic actuator.
7. The pneumatic actuator controller according to claim 2, wherein the detector detects the flow rate of the air in the air supply path or the air exhaust path, and the solenoid valve control unit transmits a subsequent operation command to the pneumatic actuator on a condition that a total amount of air flowing into the pneumatic actuator or exhausted from the pneumatic actuator after the start of the predetermined operation of the pneumatic actuator determined from the flow rate detected by the detector has reached a predetermined ratio relative to a reference value stored in advance as a value indicating an amount of air consumed by the pneumatic actuator when the predetermined operation is performed.
8. The pneumatic actuator controller according to claim 2, wherein a plurality of pneumatic actuators are connected to the solenoid valve, the solenoid valve is configured so as to be capable of controlling supply of air from the air supply path to each of the plurality of pneumatic actuators and introduction of exhaust from each of the plurality of pneumatic actuators into the air exhaust path, and the operation state judgment unit judges the operation state of each of the plurality of actuators based on data indicating a change in the flow rate or pressure of the air in the air supply path or the flow rate or pressure of the air in the air exhaust path detected by the detector when the plurality of pneumatic actuators operate in parallel.
9. The pneumatic actuator controller according to claim 8, wherein the operation state judgment unit judges that the predetermined operation of any of the plurality of pneumatic actuators has ended at a timing of a change of an edge shape of a time fluctuation waveform of the flow rate or the pressure after the operation by any of the plurality of pneumatic actuators has started, and the operation state judgment unit specifies the pneumatic actuator, among the plurality of pneumatic actuators, which has completed the predetermined operation, based on a reference value stored in advance as a value indicating an amount of air consumed by each of the plurality of pneumatic actuators when the predetermined operation is performed and a flow rate of air that has flowed into or been exhausted from each of the plurality of pneumatic actuators from the start of the predetermined operation of each of the plurality of the pneumatic actuators to the timing of the change of the edge-shape.
10. The pneumatic actuator controller according to claim 1, wherein the detector detects the flow rate of air in the air supply path, and the operation state judgment unit determines an air consumption amount or operation time when the pneumatic actuator performs a predetermined operation based on data representing change in the flow rate detected by the detector, and judges that an abnormality has occurred in the air supply path: (1) when the determined air consumption exceeds normal air consumption when the pneumatic actuator performs the predetermined operation, or (2) when the determined operation time exceeds normal operation time when the pneumatic actuator performs the predetermined operation.
11. The pneumatic actuator controller according to claim 1, wherein the detector detects the pressure of the air in the air supply path, and the operation state judgment unit judges that an abnormality has occurred in the air supply path when a rate of change in an edge portion of a time fluctuation waveform of the pressure becomes slower than the rate of change in a normal state.
12. The pneumatic actuator controller according to claim 1, wherein the detector detects the flow rate and the pressure of the air in the air supply path, the operation state judgment unit determines an air consumption amount or operation time when the pneumatic actuator performs a predetermined operation based on data representing change in the flow rate detected by the detector, and judges that an abnormality has occurred in the air supply path when the determined air consumption amount is equal to a normal air consumption amount when the pneumatic actuator performs the predetermined operation and the determined operation time exceeds a normal operation time when the pneumatic actuator performs the predetermined operation.
Description
BRIEF DESCRIPTION OF DRAWINGS
[0013]
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020]
[0021]
[0022]
[0023]
[0024]
[0025]
[0026]
DETAILED DESCRIPTION OF EMBODIMENTS OF THE INVENTION
[0027] Next, the embodiments of the present disclosure will be described with reference to the drawings. In the referenced drawings, identical constituent portions of functional portions are assigned the same reference sign. In order to facilitate understanding, the scales of the drawings have been appropriately changed. Furthermore, the aspects shown in the drawings are merely examples for carrying out the present invention, and the present invention is not limited to the illustrated aspects.
[0028]
[0029] Each of the solenoid valves 51 to 53 is electrically connected to the controller 10, and each of the solenoid valves 51 to 53 operates in accordance with operation commands from the controller. The types of air cylinders 1 to 3 and solenoid valves 51 to 53 shown here are exemplary, and other types of air cylinders (for example, single-acting air cylinders) and other types of solenoid valves (for example, three-way solenoid valves) may be used.
[0030] As shown in
[0031] The controller 10 can control each of the solenoid valves 51 to 53 by transmitting electrical signals as operation commands to the solenoid valves 51 to 53. Note that the controller 10 may have a structure as a general computer comprising a CPU, ROM, RAM, a storage device, operation units, a display unit, an input/output interface, a networking interface, etc.
[0032] The air cylinders 1 to 3 drive, for example, a gripping device (chuck) equipped on a robot device. In this case, the actuator control system 100 functions as a system which performs opening/closing control of the gripping device equipped on the robot device in accordance with commands from a host device (robot controller).
[0033] As shown in
[0034] Regarding the flow rate and pressure waveform data obtained by the flow sensor 61 and the pressure sensor 62 when the air cylinders move, as an example, the case in which only a single air cylinder 1 moves will be described with reference to
[0035]
[0036]
[0037]
[0038] At time t0, the solenoid valve 51 is driven, and the air cylinder 1 starts to move.
[0039] As shown in
[0040] After the driving of the air cylinder 1 has started, the controller 10 (operation state judgment unit 11) can judge that the movement of the air cylinder 1 has ended by capturing the timing of the decrease in flow rate in the flow rate waveform or the timing of the increase in pressure in the pressure waveform. Note that though the detection of the end of the movement when the piston rod 1a advances has been described, the end of the movement when the piston rod 1a returns from the front end to the rear end can be determined by the same method. In this manner, the controller 10 (operation state judgment unit 11) can understand the operation state (position of the piston rod) of the air cylinder by analyzing the waveform data of the flow sensor 61 or the pressure sensor 62. The controller 10 (solenoid valve control unit 12) can appropriately move to the execution of a subsequent operation command commanded by the host device under the condition that the end of the predetermined movement of the air cylinder is detected in this manner.
[0041] Note that though
[0042] According to the configuration described above, unlike the prior art, it is not necessary to arrange a sensor such as a so-called “auto switch” for each of the air cylinders in order to confirm the operation state of the air cylinders. Furthermore, even in a situation where the air chuck attempts to grip workpieces of different sizes, the end of the movement of the air cylinder (the completion of the movement for closing the chuck) can accurately be judged.
[0043]
[0044] Regarding the flow rate detected by the flow sensor 71, in the same manner as the case of the flow rate detected by the flow sensor 61 shown in
[0045] Eventually, the piston rod 1a reaches the forwardmost position (
[0046] Even in the case in which the controller 10 (operation state judgment unit 11) uses the flow sensor 71 or the pressure sensor 72 arranged in the air exhaust path 91 in this manner, by capturing the timing of the fall of the flow rate waveform or the pressure waveform, the end of the predetermined movement of the air cylinder 1 can be determined. In other words, by using either the flow sensor 71 or the pressure sensor 72 arranged in the air exhaust path 91, the same effect as the case in which either the flow sensor 61 or the pressure sensor 62 arranged in the air supply path 81 is used can be obtained.
[0047] Two examples of embodiments of air cylinder control (air cylinder control methods) by the controller 10 will be described below. The first embodiment (
[0048]
[0049] As shown in
[0050] The piston rod 1a moves to the end of the stroke, the pressure in the air cylinder 1 rises, the theoretical cylinder thrust is generated, and when the movement of the air cylinder 1 ends (box K3), the inflow of air into the air cylinder 1 is stopped and the flow rate drops to zero, whereby the pressure returns to the original high state. In step S2, the controller 10 (operation state judgment unit 11) detects that the piston rod 1a of the air cylinder 1 has reached the stroke end (the movement of the air cylinder 1 is complete) by monitoring the waveform of the inflow amount and the waveform of the pressure. The monitoring in step S2 is continued until a change in which the flow rate drops to zero and the pressure returns to the original level is detected (S2: NG).
[0051] When the change wherein the flow rate drops to zero and the pressure returns to the original level is detected (S2: OK), the controller 10 understands that the movement of the air cylinder 1 is complete, i.e., the piston rod had reached the stroke end and the cylinder thrust has been generated, and turns off the solenoid valve 51. The solenoid valve 51 may remain on until the next movement. As a result, the process ends.
[0052] According to the first embodiment, even in a situation where workpieces of different sizes are gripped by an air chuck, the operation state of the air cylinder can be appropriately determined with a simple structure. By understanding the position of the piston rod 1a of the air cylinder 1 in this manner, the controller 10 can accurately move to the control of a subsequent operation command.
[0053] Next, the second embodiment of air cylinder control by the controller 10 will be described. In the second embodiment, the controller 10 moves three air cylinders 1 to 3 in parallel. It will be assumed that the air cylinders 1 to 3 have the same cylinder chamber inner diameters, and the total lengths (maximum strokes) thereof have the following relationship:
Air cylinder 2>Air cylinder 1>Air cylinder 3
[0054] When the air cylinders 1 to 3 are moved in parallel, the flow sensor 61 and the pressure sensor 62 provide waveform data obtained by compositing the waveform data of the cases in which the air cylinders 1 to 3 are individually moved (the waveform data graph at the bottom of
[0055]
[0056] In
[0057] The state in which the flow rate increases and the pressure decreases continues until the piston rod 1a reaches the front end at time t12. When the piston rod 1a reaches the front end and the forward movement of the piston rod 1a ends, the flow rate decreases, the pressure increases, and the original state is restored. The controller 10 starts driving the air cylinder 1 in the retracting direction at time t13. Along with this, the flow rate increases and the pressure begins to decrease. The state in which the flow rate increases and the pressure decreases continues until the piston rod 1a returns to the rear end position. At time t14 when the piston rod 1a returns to the rear end position, the flow rate decreases, the pressure increases, and the original state is restored.
[0058] In the waveform data of
[0059] In
[0060] In
[0061] The operation for understanding the position of each of the air cylinders 1 to 3 by waveform analysis of the composite waveform will be described below. When the air cylinders 1 to 3 perform the movements of the operation waveforms shown in
[0062]
[0063] In step S103, the controller 10 turns on the solenoid valve 52 at time t21. The controller 10 monitors the waveform data detected by the flow sensor 61 and the pressure sensor 62 (step S104). The controller 10 waits for the waveform data to change and the start of the movement of the air cylinder 1 to be confirmed (step S104: NG). As the solenoid valve 52 is turned on, the air cylinder 2 beings to move (box K103), the flow rate increases, and the pressure decreases (box K104). When the start of movement is confirmed by the change of the waveform data (S104: OK), the process proceeds to the next step S105. At this stage, the end of the movement of the air cylinder does not occur.
[0064] In step S105, the controller 10 turns on the solenoid valve 53 at time t31. The controller 10 monitors the waveform data detected by the flow sensor 61 and the pressure sensor 62 (step S106). The controller 10 waits for the end of the movement of any of the air cylinders (S106: NG). As the solenoid valve 53 is turned on, the air cylinder 3 begins to move (box K105), the flow rate increases, and the pressure decreases (box K106).
[0065] At time t12 after the start of the movement of the air cylinder 3, the movement of the air cylinder 1 ends (box K107), a change in which the flow rate decreases and the pressure increases occurs (box K108). The controller 10 (operation state judgment unit 11) captures the change in the falling edge in this case in the flow rate waveform (or the change in the rising edge in this case in the pressure waveform) (the portion indicated by reference sign F1). Specifically, the operation state judgment unit 11 captures an edge-like change in the flow rate waveform or the pressure waveform. The portion where the flow rate waveform falls or the portion where the pressure waveform rises is the timing when the movement of any of the air cylinders 1 to 3 is complete. The controller 10 specifies, for example, the air cylinder for which the movement is complete by the following operation.
[0066] The controller 10 retains a table in which the consumption amount of air when, for example, each of the air cylinders 1 to 3 is moved from the rear end position to the forwardmost position is stored. For example, the reference values retained in the table as the air consumption amount when each of the air cylinders 1 to 3 moves from the rear end position to the forwardmost position are as follows.
[0067] Air cylinder 1: V1 (liters)
[0068] Air cylinder 2: V2 (liters)
[0069] Air cylinder 3: V3 (liters)
[0070] The controller 10 acquires the flow rate when each air cylinder moves by, for example, detecting the height of the rise of the flow rate immediately after the start of movement. Alternatively, the flow rate of each air cylinder may be stored in advance by test operation. As an example, the flow rate detected for the air cylinder 1 is C1 (L/min). By multiplying the elapsed time from time t11 when the movement of the air cylinder 1 begins to the time t12 when the falling edge of the flow rate waveform is detected by the flow rate C1 (formula (1) below), the amount of air inflow for the air cylinder 1 can be determined.
(Air inflow of air cylinder 1)=C1×(elapsed time) (1)
[0071] When the air inflow amount of the air cylinder 1 determined in this manner substantially matches the air consumption amount V1 in the forward movement of the air cylinder 1 stored in advance, it can be specified that the air cylinder for which the movement is complete is the air cylinder 1. In this case, the air inflow amount from the time t11 to the time t12 is calculated in the same manner for the air cylinders 2 and 3, and comparison with V2 and V3 in the forward move of the air cylinders 2 and 3 stored in advance is also performed. The air inflow amount from the time t11 to the time t12 calculated for the air cylinders 2 and 3 does not match the air consumption amounts V2 and V3 for the air cylinders 2 and 3.
[0072] For the falling edges of the flow rate waveform detected at time t32 and time t22, the air cylinder for which the movement has ended is specified in the same manner.
[0073] When the end of the movement of the air cylinder 1 is confirmed in this manner (S106: OK), the controller 10 turns off the solenoid valve 51 (step S107). The controller 10 then monitors the waveform data detected by the flow sensor 61 and the pressure sensor 62 (step S108). The controller 10 waits for the end of the movement of any of the air cylinders (S108: NG).
[0074] At time t32, the movement of the air cylinder 3 ends (box K109), and a change in which the flow rate further decreases and the pressure further increases occurs (box K110). The controller 10 captures the change in the falling edge in this case of the flow rate waveform (or the change in the rising edge in this case of the pressure waveform) (the portion indicated by reference sign F2). The portion where the flow rate waveform falls or the portion where the pressure waveform rises is the timing when the movement of any of the air cylinders 1 to 3 has completed. The controller 10 specifies the air cylinder for which the movement has completed by the same method as the method described above for specifying the end of the movement of the air cylinder 1. Since the amount of air flowing into the air cylinder 3 between the time t31 and the time t32 is substantially the same as the air consumption amount V3 of the air cylinder 3, it can be specified that the air cylinder for which the movement has completed is the air cylinder 3.
[0075] When the end of movement of the air cylinder 3 is confirmed in this manner (S108: OK), the controller 10 turns off the solenoid valve 53 (step S109). The controller 10 then monitors the waveform data detected by the flow sensor 61 and the pressure sensor 62 (step S110). The controller 10 waits for the end of the movement of any of the air cylinders (S110: NG).
[0076] At time t22, the movement of the air cylinder 2 ends (box K111), the flow rate becomes zero, and the pressure returns to the original state (box K112). The controller 10 captures the change in the falling edge in this case of the flow rate waveform (or the change in the rising edge in this case of the pressure waveform) (the portion indicated by the symbol F3). The portion where the flow rate waveform falls or the portion where the pressure waveform rises is the timing when the movement of any of the air cylinders 1 to 3 is complete. The controller 10 specifies the air cylinder for which the movement has completed by the same method as the method described above for specifying the end of the movement of the air cylinder 1. Since the amount of air flowing into the air cylinder 2 between the time t21 and the time t22 is substantially the same as the air consumption amount V2 of the air cylinder 2, it can be specified that the air cylinder for which the move has completed is the air cylinder 2. When the end of movement of the air cylinder 2 is confirmed in this manner (S110: OK), the controller 10 turns off the solenoid valve 52 (step S111).
[0077] According to the second embodiment, by configuring the sensor (detector) arranged on the primary side (air supply source side) of the solenoid valve to detect the air flow rate and pressure, even when a plurality of air cylinders are connected to the secondary side of the solenoid valve, the operation state of each air cylinder can be appropriately determined without incurring complication of wiring that occurs when auto switches are attached to the air cylinders.
[0078] Note that though the end of movement of each air cylinder is determined using the flow sensor 61 or pressure sensor 62 arranged in the air supply path in the second embodiment described above, the end of the movement of each air cylinder can likewise be determined using the flow sensor 71 or pressure sensor 72 arranged in the air exhaust path.
[0079] The operation state judgment unit 11 of the controller 10 may be configured to detect that an abnormality has occurred in, for example, the air hose forming the air supply path 81 by analyzing the operation waveform of the flow sensor 61 and/or the pressure sensor 62. Examples of operations for detecting abnormality in the air supply path 81 will be described below. Operation example 1 and operation example 2 are examples of detecting that a defect (hole, etc.) has occurred in the air supply path 81 (air hose), and operation example 3 is an example of detecting a state in which the air supply path 81 (air hose) has become kinked, making it difficult for air to flow.
[0080] (Operation example 1) For example, the normal air consumption amount when the air cylinder 1 moves from the rear end position to the forwardmost position is defined as V1 (liter) and the operation time is defined as T101 (seconds). The operation state judgment unit 11 analyzes the waveform of the air flow rate after the actuator control system 100 has operated for some time, and using the above-mentioned formula (1) or the like, acquires the consumption amount (inflow amount) of air and operation time when the air cylinder 1 moves from the rear end position to the forwardmost position. Further, when the consumption amount of air acquired in this manner exceeds V1 (liter) or when the operation time exceeds T101 (seconds), the operation state judgment unit 11 judges that a defect has occurred in the air supply path 81 since the air consumption amount has increased or air inflow takes more time as compared to normal operation.
[0081] (Operation example 2) It is considered that when a defect has occurred in the air supply path 81, the rate of change of the rising edge and falling edge of the pressure fluctuation waveform detected by the pressure sensor 62 becomes blunt. The operation state judgment unit 11 can judge that a defect has occurred in the air supply path 81 when the rise or rate of change of the rising edge of the pressure waveform detected by the pressure sensor 62 is slower than in the normal state.
[0082] (Operation example 3) It will be assumed that the air hose forming the air supply path 81 is kinked, making it difficult for air to flow. In this case, since the air flow rate decreases as a whole, the air consumption amount is equal to the normal consumption amount V1, but the operation time is longer than the normal operation time T101. Thus, when such a situation occurs, the operation state judgment unit 11 can judge that the air hose is kinked, whereby air inflow is difficult.
[0083] According to the present embodiment as described above, by configuring the sensor (detector) arranged on the primary side (air supply source side) of the solenoid valve to detect the air flow rate and pressure, even when a plurality of air cylinders are connected to the solenoid valve, the operation state (position) of each air cylinder can properly be determined without causing complication of wiring, as in the case in which auto switches are used. Furthermore, even in a situation where workpieces of different sizes are gripped by an air chuck, the operation states of the air cylinders can be appropriately determined with a simple structure.
[0084] Specifically, according to the embodiments described above, complication of wiring and the like that may occur when an auto switch is used can be avoided.
[0085] Though the present invention has been described above using typical embodiments, a person skilled in the art could understand that modification and various other changes, omissions, and additions can be made to the embodiments described above without deviation from the scope of the present invention.
[0086] In the embodiments described above, as described in, for example, the flowchart of
[0087] The functional blocks of the controller 10 shown in
[0088] The program for executing the air cylinder control process of the embodiments described above can be recorded on various computer-readable recording media (for example, semiconductor memory such as ROM, EEPROM, and flash memory, magnetic recording medium, or an optical disk such as a CD-ROM or DVD-ROM).
DESCRIPTION OF REFERENCE SIGNS
[0089] 1, 2, 3 air cylinder [0090] 1a, 2a, 3a piston rod [0091] 5 solenoid valve [0092] 10 controller [0093] 11 operation state judgment unit [0094] 12 solenoid valve control unit [0095] 51, 52, 53 solenoid valve [0096] 61, 71 flow sensor [0097] 62, 72 pressure sensor [0098] 81 air supply path [0099] 91 air exhaust path [0100] 100 actuator control system