TWI631440B - Servo cylinder system - Google Patents
Servo cylinder system Download PDFInfo
- Publication number
- TWI631440B TWI631440B TW106100810A TW106100810A TWI631440B TW I631440 B TWI631440 B TW I631440B TW 106100810 A TW106100810 A TW 106100810A TW 106100810 A TW106100810 A TW 106100810A TW I631440 B TWI631440 B TW I631440B
- Authority
- TW
- Taiwan
- Prior art keywords
- command voltage
- control object
- teaching
- cylinder
- start command
- Prior art date
Links
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B21/00—Common features of fluid actuator systems; Fluid-pressure actuator systems or details thereof, not covered by any other group of this subclass
- F15B21/08—Servomotor systems incorporating electrically operated control means
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B13/00—Details of servomotor systems ; Valves for servomotor systems
- F15B13/02—Fluid distribution or supply devices characterised by their adaptation to the control of servomotors
- F15B13/04—Fluid distribution or supply devices characterised by their adaptation to the control of servomotors for use with a single servomotor
- F15B13/044—Fluid distribution or supply devices characterised by their adaptation to the control of servomotors for use with a single servomotor operated by electrically-controlled means, e.g. solenoids, torque-motors
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B13/00—Details of servomotor systems ; Valves for servomotor systems
- F15B13/16—Special measures for feedback, e.g. by a follow-up device
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B15/00—Fluid-actuated devices for displacing a member from one position to another; Gearing associated therewith
- F15B15/20—Other details, e.g. assembly with regulating devices
- F15B15/28—Means for indicating the position, e.g. end of stroke
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B9/00—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member
- F15B9/02—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type
- F15B9/03—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type with electrical control means
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B9/00—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member
- F15B9/02—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type
- F15B9/08—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type controlled by valves affecting the fluid feed or the fluid outlet of the servomotor
- F15B9/09—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type controlled by valves affecting the fluid feed or the fluid outlet of the servomotor with electrical control means
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B9/00—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member
- F15B9/02—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type
- F15B9/08—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type controlled by valves affecting the fluid feed or the fluid outlet of the servomotor
- F15B9/10—Servomotors with follow-up action, e.g. obtained by feed-back control, i.e. in which the position of the actuated member conforms with that of the controlling member with servomotors of the reciprocatable or oscillatable type controlled by valves affecting the fluid feed or the fluid outlet of the servomotor in which the controlling element and the servomotor each controls a separate member, these members influencing different fluid passages or the same passage
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F15—FLUID-PRESSURE ACTUATORS; HYDRAULICS OR PNEUMATICS IN GENERAL
- F15B—SYSTEMS ACTING BY MEANS OF FLUIDS IN GENERAL; FLUID-PRESSURE ACTUATORS, e.g. SERVOMOTORS; DETAILS OF FLUID-PRESSURE SYSTEMS, NOT OTHERWISE PROVIDED FOR
- F15B2211/00—Circuits for servomotor systems
- F15B2211/60—Circuit components or control therefor
- F15B2211/665—Methods of control using electronic components
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Fluid Mechanics (AREA)
- Mechanical Engineering (AREA)
- General Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Analytical Chemistry (AREA)
- Control Of Position Or Direction (AREA)
- Fluid-Pressure Circuits (AREA)
- Servomotors (AREA)
Abstract
本發明提供伺服氣缸系統,其能夠改善氣缸起動時的回應性,能夠謀求位置控制性能的均勻化及其維持。伺服氣缸系統(1)具有氣缸(3)、伺服閥(2)、位置檢測感測器(4)和控制器(5),在該伺服氣缸系統(1)中,向伺服閥(2)輸出指令電壓以使控制物件(9)從規定的原點位置(HP)移動,並在控制物件(9)通過從原點位置(HP)離開規定量的示教位置(X1、X2)時檢測出驅動開始指令電壓(Y1、Y2)並存儲,在輸出使控制物件(9)從當前位置向目標位置移動的動作指示的情況下,將驅動開始指令電壓(Y1、Y2)與動作指示輸入之後最先基於偏差計算出的第一指令電壓相加而計算出第二指令電壓,並將第二指令電壓輸出至伺服閥(2)。 The present invention provides a servo cylinder system that can improve the responsiveness at the start of a cylinder, and can achieve uniformity and maintenance of position control performance. The servo cylinder system (1) includes a cylinder (3), a servo valve (2), a position detection sensor (4), and a controller (5). The servo cylinder system (1) outputs to the servo valve (2) Command the voltage to move the control object (9) from the specified origin position (HP), and detect when the control object (9) leaves the teaching position (X1, X2) by a predetermined amount from the origin position (HP) The driving start command voltages (Y1, Y2) are stored and stored. When an operation instruction is output to move the control object (9) from the current position to the target position, the driving start command voltages (Y1, Y2) and the operation instruction are inputted. First, the first command voltage calculated based on the deviation is added to calculate a second command voltage, and the second command voltage is output to the servo valve (2).
Description
本發明係有關於伺服氣缸系統,其根據位置檢測單元所檢測出的控制物件的檢測位置與目標位置之間的偏差,從控制器向伺服閥輸出指令電壓,由此對氣缸的壓力室進行壓縮空氣的給排氣,對控制物件的位置進行控制。 The present invention relates to a servo cylinder system, which outputs a command voltage from a controller to a servo valve based on a deviation between a detected position of a control object and a target position detected by a position detection unit, thereby compressing a pressure chamber of a cylinder Supply and exhaust air to control the position of the control object.
伺服氣缸系統通過伺服閥進行向氣缸的壓力室供給的壓縮空氣的給排氣,使控制物件相對於氣缸進退。控制物件的位置由位置檢測單元檢測出。控制器輸入位置檢測單元所檢測出的檢測位置,並將其與目標位置進行比較,基於它們的偏差對向伺服閥輸出的指令電壓進行PID控制,由此對控制物件的位置進行回饋控制。該伺服氣缸系統緊湊、輕型且成本低,因此在以半導體製造設備為代表的廣泛領域中使用(例如參照專利文獻1、專利文獻2等)。 The servo cylinder system supplies and discharges compressed air supplied to the pressure chamber of the cylinder through a servo valve, and advances and retreats the control object with respect to the cylinder. The position of the control object is detected by the position detection unit. The controller inputs the detection position detected by the position detection unit, compares it with the target position, and performs PID control on the command voltage output to the servo valve based on their deviation, thereby performing feedback control on the position of the control object. This servo cylinder system is compact, lightweight, and low in cost, and is therefore used in a wide range of fields represented by semiconductor manufacturing equipment (for example, refer to Patent Document 1, Patent Document 2, etc.).
專利文獻1:日本特開平7-35107號公報 Patent Document 1: Japanese Patent Application Laid-Open No. 7-35107
專利文獻2:日本特開2006-57724號公報 Patent Document 2: Japanese Patent Application Laid-Open No. 2006-57724
然而,在以往的伺服氣缸系統中存在以下的問題。例如,在將伺服氣缸系統使用於半導體製造設備的情況下,伴隨著半導體的微小化,伺服氣缸系統被要求以高精度對控制物件的位置進行控制。但是,伺服氣缸系統因氣缸、伺服閥、位置檢測單元的特性不同而會在產品間產生回應性上的差別,因此不容易使位置控制性能在產品間均勻化。此外,伺服氣缸系統由於例如氣缸、伺服閥的滑動部的磨損等經長時間而劣化的原因,存在回應性變化而無法維持位置控制性能的情況。 However, the conventional servo cylinder system has the following problems. For example, when a servo cylinder system is used in a semiconductor manufacturing facility, with the miniaturization of semiconductors, the servo cylinder system is required to control the position of a control object with high accuracy. However, the servo cylinder system has different responsiveness among products due to different characteristics of the cylinder, servo valve, and position detection unit, so it is not easy to make the position control performance uniform among products. In addition, the servo cylinder system may be deteriorated in response to changes such as abrasion of a sliding portion of a cylinder or a servo valve over a long period of time, and thus may not be able to maintain position control performance.
以往,為了容許伺服氣缸系統的回應性的差別和變化、或是為了消除回應性的差別和變化,控制器需要對PID參數進行調整。但是,對於前者,伺服氣缸系統的位置控制精度降低。對於後者,PID參數的調整複雜,調整需要許多時間。 In the past, in order to allow the difference and change of the responsiveness of the servo cylinder system, or to eliminate the difference and change of the responsiveness, the controller needs to adjust the PID parameters. However, with the former, the position control accuracy of the servo cylinder system is reduced. For the latter, adjustment of the PID parameters is complicated and adjustment takes a lot of time.
本發明正是為了解決上述問題點而完成的,其目的在於提供伺服氣缸系統,該伺服氣缸系統能夠改善回應性,從而能夠謀求位置控制性能的均勻化及其維持。 The present invention has been made in order to solve the above-mentioned problems, and an object thereof is to provide a servo cylinder system which can improve the responsiveness, thereby achieving uniformity and maintenance of position control performance.
為了解決上述課題,本發明的一方式具有如下那樣的構成。 In order to solve the above-mentioned problems, one embodiment of the present invention has the following configuration.
(1)一種伺服氣缸系統,具有:氣缸,其根據壓力室的壓力而使控制物件沿直線方向進退;伺服閥,其對上述壓力室給排壓縮空氣;位置檢測單元,其檢測上述控制物件的位置;及控制器,其輸入上述位置檢測單元檢測出的檢測位 置,求出與目標位置之間的偏差,並基於上述偏差向上述伺服閥輸出指令電壓,其特徵在於:上述控制器具有:示教單元,其向上述伺服閥輸出指令電壓以使得上述控制物件從規定的原點位置移動,並且檢測出上述控制物件通過從上述原點位置離開規定量的示教位置時的指令電壓,並將其作為驅動開始指令電壓存儲;及起動時電壓調整單元,其在輸入了使上述控制物件從當前的位置向目標位置移動的動作指示的情況下,將上述驅動開始指令電壓與輸入上述動作指示之後最先基於上述偏差計算出的第一指令電壓相加而計算出第二指令電壓,並將上述第二指令電壓輸出至上述伺服閥。 (1) A servo cylinder system comprising: a cylinder that advances and retreats a control object in a linear direction according to the pressure of a pressure chamber; a servo valve that supplies and discharges compressed air to the pressure chamber; and a position detection unit that detects A position; and a controller that inputs a detection position detected by the position detection unit To determine a deviation from the target position, and output a command voltage to the servo valve based on the deviation, characterized in that the controller includes a teaching unit that outputs a command voltage to the servo valve so that the control object A command voltage when the control object moves from a predetermined origin position and a predetermined amount of the teaching position moves away from the origin position by a predetermined amount, and stores it as a drive start command voltage; and a voltage adjustment unit at start-up, which When an operation instruction to move the control object from the current position to the target position is input, the driving start instruction voltage is added to the first instruction voltage calculated first based on the deviation after the operation instruction is input and calculated. The second command voltage is output, and the second command voltage is output to the servo valve.
此處,“從規定的原點位置移動”包括:使控制物件從規定的原點位置向從氣缸伸出的方向移動的情況;使控制物件從規定的原點位置嚮往氣缸側後退的方向移動的情況;還有使控制物件以從規定的原點位置向從氣缸突出的方向移動之後又朝著氣缸側後退的方式往復地移動的情況。 Here, "moving from a predetermined origin position" includes a case where a control object is moved from a predetermined origin position to a direction extending from a cylinder, and a control object is moved from a predetermined origin position to a direction toward the cylinder side. In some cases, the control object may be moved back and forth in such a manner that the control object moves from a predetermined origin position to a direction protruding from the cylinder and then moves back toward the cylinder side.
在上述構成中,控制器通過示教單元使伺服氣缸系統的構成部件實際地運轉並向伺服閥輸出指令電壓,使控制物件從原點位置移動。此時,控制器檢測出控制物件通過從原點位置離開規定量的示教位置時的指令電壓,並將其作為驅動開始指令電壓存儲。因此,驅動開始指令電壓為該伺服氣缸系統能夠使氣缸確實地起動的值。 In the above configuration, the controller actually operates the constituent parts of the servo cylinder system through the teaching unit and outputs a command voltage to the servo valve to move the control object from the origin position. At this time, the controller detects a command voltage when the control object passes a predetermined amount of the teaching position from the origin position, and stores the command voltage as a drive start command voltage. Therefore, the drive start command voltage is a value at which the servo cylinder system can reliably start the cylinder.
控制器在輸入了使控制物件從當前的位置向目標位置移動的動作指示的情況下,基於位置檢測單元所檢測出的檢測位置與目標位置之間的偏差向伺服閥輸出指令電壓。此 時,控制器將通過上述的示教動作存儲的驅動開始指令電壓與通過起動時電壓調整單元在動作指示輸入之後最先基於偏差計算出的第一指令電壓相加,由此計算出第二指令電壓,並將該第二指令電壓輸出至伺服閥。氣缸由於被施加比第一指令電壓大的第二指令電壓,所以當對伺服閥輸出第二指令電壓時立即起動,使控制物件從當前的位置朝著目標位置開始移動。氣缸和伺服閥在起動時需要大的力,但是起動後則容易順暢地動作。因此,伺服氣缸系統在氣缸起動之後,根據控制器基於檢測位置與目標位置的偏差而輸出的指令電壓使控制物件向目標位置移動。 When the controller inputs an operation instruction to move the control object from the current position to the target position, the controller outputs a command voltage to the servo valve based on a deviation between the detected position detected by the position detection unit and the target position. this At this time, the controller adds the driving start command voltage stored by the teaching operation described above and the first command voltage first calculated based on the deviation after the operation instruction input by the start-time voltage adjustment unit to calculate the second command. Voltage, and outputs the second command voltage to the servo valve. Since the second command voltage larger than the first command voltage is applied to the cylinder, the cylinder is started immediately when the second command voltage is output to the servo valve, so that the control object starts to move from the current position toward the target position. The cylinder and the servo valve require a large amount of force at the time of starting, but it is easy to move smoothly after starting. Therefore, after the cylinder is started, the servo cylinder system moves the control object to the target position based on the command voltage output by the controller based on the deviation between the detected position and the target position.
這樣,上述構成的伺服氣缸系統在輸入動作指示之後,向伺服閥輸出比最先僅基於偏差而計算出的第一指令電壓大的第二指令電壓,因此,即使構成伺服氣缸系統的氣缸、伺服閥等構成部件的特性在產品之間不同、或經長時間而劣化,也能夠使氣缸回應性良好地起動。因此,上述結構的伺服氣缸系統能夠根據產品的特性、劣化狀態而改善回應性,能夠使位置控制性能在產品間均勻化,並且能夠維持初始的位置控制性能。 In this way, the servo cylinder system configured as above outputs a second command voltage greater than the first command voltage calculated based on the deviation first based on the deviation after the input of the operation instruction. Therefore, even the cylinders and servos constituting the servo cylinder system The characteristics of components such as valves differ among products or deteriorate over time, and the cylinder can be started with good responsiveness. Therefore, the servo cylinder system having the above structure can improve the responsiveness according to the characteristics and degradation state of the product, can uniformize the position control performance among the products, and can maintain the initial position control performance.
(2)在(1)所述的構成中,優選上述示教單元將上述示教位置設定在根據向上述原點位置移動之前的上述控制物件的位置而產生的上述驅動開始指令電壓的差小的範圍內。 (2) In the configuration described in (1), it is preferable that the teaching unit sets the teaching position to a small difference in the drive start command voltage generated based on a position of the control object before moving to the origin position. In the range.
在上述構成中,不論示教動作開始時控制物件在哪個位置停止,通過示教動作檢測出的驅動開始指令電壓的差 都小。因此,不論進行示教動作時控制物件的位置為何處,在使控制物件向目標位置移動的情況下,都能夠向伺服閥輸出比在動作指示輸入後最先僅基於偏差計算出的第一指令電壓大的第二指令電壓,使氣缸立即起動。由此,根據上述構成,即使不根據控制物件的位置改變示教動作和通常動作的控制,也能夠改善響應性。 In the above configuration, regardless of where the control object stops at the start of the teaching operation, the difference in the drive start command voltage detected by the teaching operation Both are small. Therefore, regardless of the position of the control object during the teaching operation, when the control object is moved to the target position, it is possible to output to the servo valve the first instruction calculated based on the deviation first after the operation instruction is input. The second command voltage with a large voltage causes the cylinder to start immediately. Thus, according to the above configuration, it is possible to improve the responsiveness without changing the control of the teaching operation and the normal operation according to the position of the control object.
(3)在(1)或(2)所述的構成中,優選上述示教單元具有準備單元,上述準備單元在使上述控制物件向上述原點位置移動之前,向上述伺服閥輸出指令電壓,使得上述控制物件移動至向上述氣缸相反側最大程度伸出的最大伸出位置。 (3) In the configuration described in (1) or (2), the teaching unit preferably includes a preparation unit that outputs a command voltage to the servo valve before moving the control object to the origin position, The control object is moved to a maximum extension position that is maximally extended toward the opposite side of the cylinder.
在上述構成中,由於具有對於示教動作時進行穩定的控制而言足夠的距離,所以,與使控制物件從最大伸出位置以外的位置到達原點位置的情況相比,能夠降低超調量,從而能夠使控制物件儘快地到達原點位置。由此,根據上述構成,能夠使控制物件以短時間高精度地到達原點位置。 In the above configuration, since there is a sufficient distance for stable control during teaching operation, the amount of overshoot can be reduced compared to a case where the control object reaches the origin position from a position other than the maximum extended position. , So that the control object can reach the origin position as soon as possible. Thus, according to the above configuration, the control object can be brought to the origin position with high accuracy in a short time.
因此,根據本發明,能夠提供伺服氣缸系統,該伺服氣缸系統能夠改善氣缸起動時的回應性,從而能夠謀求位置控制性能的均勻化及其維持。 Therefore, according to the present invention, it is possible to provide a servo cylinder system that can improve the responsiveness at the time of starting the cylinder, and can achieve uniformity and maintenance of the position control performance.
1‧‧‧伺服氣缸系統 1‧‧‧Servo cylinder system
2‧‧‧伺服閥 2‧‧‧Servo valve
3‧‧‧氣缸 3‧‧‧ cylinder
4‧‧‧位置檢測感測器(位置檢測單元的一例) 4‧‧‧Position detection sensor (an example of a position detection unit)
5‧‧‧控制器 5‧‧‧controller
5a‧‧‧示教程式(示教單元、準備單元的一例) 5a‧‧‧Tutorial (example of teaching unit and preparation unit)
5b‧‧‧通常動作程式(起動時電壓調整單元的一例) 5b‧‧‧Normal operation program (an example of a voltage adjustment unit at startup)
9‧‧‧控制物件 9‧‧‧ Control Object
32‧‧‧壓力室 32‧‧‧Pressure chamber
HP‧‧‧原點位置 HP‧‧‧ origin position
X1‧‧‧第一示教位置(示教位置的一例) X1‧‧‧First teaching position (an example of teaching position)
X2‧‧‧第二示教位置(示教位置的一例) X2‧‧‧Second teaching position (an example of teaching position)
Y1‧‧‧下降用驅動開始指令電壓(驅動開始指令電壓的一例) Y1‧‧‧falling drive start command voltage (an example of drive start command voltage)
Y2‧‧‧上升用驅動開始指令電壓(驅動開始指令電壓的一例) Y2‧‧‧ rising drive start command voltage (an example of drive start command voltage)
圖1是本發明實施形態的伺服氣缸系統的回路圖。 FIG. 1 is a circuit diagram of a servo cylinder system according to an embodiment of the present invention.
圖2是示教程式的流程圖。 FIG. 2 is a flowchart showing a tutorial type.
圖3是說明示教動作的曲線圖,在橫軸示出時間,在左側縱軸示出位置,在右側縱軸示出指令電壓。 FIG. 3 is a graph illustrating a teaching operation. Time is shown on the horizontal axis, position is shown on the left vertical axis, and command voltage is shown on the right vertical axis.
圖4是說明因控制物件的移動開始位置的差別而引起的氣缸動作方式的不同的圖。 FIG. 4 is a diagram illustrating a difference in a cylinder operation method due to a difference in a movement start position of a control object.
圖5是說明因示教動作開始時控制物件的位置的差別而引起的上升用及下降用驅動開始指令電壓的不同的圖。 FIG. 5 is a diagram for explaining the difference in drive start command voltages for raising and lowering due to differences in the position of a control object at the start of a teaching operation.
圖6是圖5的A部放大圖。 FIG. 6 is an enlarged view of part A of FIG. 5.
圖7是示出示教規定移動量試驗的結果的圖。 FIG. 7 is a diagram showing results of a teaching of a predetermined movement amount.
圖8是示出示教位置試驗的結果的圖。 FIG. 8 is a diagram showing the results of a teaching position test.
圖9是示出通常動作程式的流程圖的圖。 FIG. 9 is a flowchart showing a normal operation program.
以下,基於圖面對本發明的伺服氣缸系統的實施形態進行說明。在以下的說明中,首先說明伺服氣缸系統1的概略構成。接著對示教動作進行說明。然後對通常動作進行說明。之後,說明在示教動作開始時使控制物件9向下限位置移動之後又向原點位置HP移動的理由。然後,說明確定示教規定移動量Z以及第一及第二示教位置X1、X2(示教位置的一例)的方法。最後,說明本實施形態的伺服氣缸系統1的作用效果。 Hereinafter, an embodiment of a servo cylinder system according to the present invention will be described based on the drawings. In the following description, a schematic configuration of the servo cylinder system 1 will be described first. Next, the teaching operation will be described. Then, the normal operation will be described. The reason for moving the control object 9 to the lower limit position at the start of the teaching operation and then to the origin position HP will be described below. Next, a method of determining the teaching predetermined movement amount Z and the first and second teaching positions X1 and X2 (an example of the teaching position) will be described. Finally, the operational effects of the servo cylinder system 1 according to this embodiment will be described.
<伺服氣缸系統的概略構成> <Outline Configuration of Servo Cylinder System>
圖1是本發明實施形態的伺服氣缸系統1的回路圖。伺服氣缸系統1包括伺服閥2、氣缸3、位置檢測感測器4以及控制器5,該伺服氣缸系統1對控制物件9的位置進行控制。伺服氣缸系統1的特徵在於:控制器5所存儲的示教程式5a(參 照後述的圖2)和通常動作程式5b(尤其是後述圖9的S26~S29、S31所示的起動時電壓調整單元)。 FIG. 1 is a circuit diagram of a servo cylinder system 1 according to an embodiment of the present invention. The servo cylinder system 1 includes a servo valve 2, a cylinder 3, a position detection sensor 4, and a controller 5. The servo cylinder system 1 controls the position of a control object 9. The servo cylinder system 1 is characterized in that the instruction formula 5a (reference Refer to FIG. 2 described later) and the normal operation program 5b (especially the start-up voltage adjustment means shown in S26 to S29 and S31 of FIG. 9 described later).
如圖1所示,氣缸3以使得控制物件9沿上下方向進退的方式配置。氣缸3中,活塞33以能夠滑動的方式被裝填在氣缸本體31中。氣缸本體31的壓力室32被活塞33氣密性地劃分為第一壓力室32a和第二壓力室32b。氣缸本體31為了與第一壓力室32a連通而形成有第一操作口31a,為了與第二壓力室32b連通而開設有第二操作口31b。氣缸3中,第一及第二操作口31a、31b經由第一及第二給排通路6b、6c而連接於伺服閥2,於是第一及第二壓力室32a、32b的內壓能夠被控制。在活塞33上連結有輸出杆34。控制物件9結合於輸出杆34的前端部,並與活塞33一體地進退。 As shown in FIG. 1, the air cylinder 3 is arrange | positioned so that the control object 9 may advance and retreat in an up-down direction. In the cylinder 3, a piston 33 is slidably mounted in the cylinder body 31. The pressure chamber 32 of the cylinder body 31 is air-tightly divided into a first pressure chamber 32 a and a second pressure chamber 32 b by the piston 33. The cylinder body 31 is formed with a first operation port 31a for communicating with the first pressure chamber 32a, and a second operation port 31b is opened for communicating with the second pressure chamber 32b. In the cylinder 3, the first and second operation ports 31a and 31b are connected to the servo valve 2 via the first and second supply and exhaust passages 6b and 6c, so that the internal pressure of the first and second pressure chambers 32a and 32b can be controlled. . An output rod 34 is connected to the piston 33. The control article 9 is coupled to the front end portion of the output lever 34 and advances and retracts integrally with the piston 33.
這樣的氣缸3中,根據第一壓力室32a的內壓所引起的向下的力加上控制物件9的重量而得的力與第二壓力室32b的內壓所引起的向上的力之差,活塞33在氣缸本體31內進行往復直線運動,從而使控制物件9下降(伸出)或是上升(後退)。位置檢測感測器4安裝於氣缸本體31的側面,其從活塞33的位置檢測出控制物件9的位置。 In such a cylinder 3, the difference between the downward force caused by the internal pressure of the first pressure chamber 32a plus the force obtained by controlling the weight of the article 9 and the upward force caused by the internal pressure of the second pressure chamber 32b The piston 33 performs a reciprocating linear motion in the cylinder body 31, so that the control object 9 is lowered (extended) or raised (retreated). The position detection sensor 4 is mounted on the side of the cylinder body 31 and detects the position of the control object 9 from the position of the piston 33.
伺服閥2是公知的方向切換閥。伺服閥2被構成為:當從控制器5輸出的指令電壓被施加於電磁螺線管23時,閥芯22與指令電壓成比例地在殼體21內移動,從而對第一口21a、第二口21b、第三口21c以及排氣流路21d之間的連通狀態進行切換。 The servo valve 2 is a known directional switching valve. The servo valve 2 is configured such that when a command voltage output from the controller 5 is applied to the electromagnetic solenoid 23, the valve element 22 moves in the housing 21 in proportion to the command voltage, so that the first port 21a, the first The communication states between the second port 21b, the third port 21c, and the exhaust flow path 21d are switched.
第一~第三口21a~21c開設於殼體21。第一口21a 經由輸入通路6a而連接於壓縮空氣供給源。第二口21b經由第一給排通路6b而連接於氣缸3的第一操作口31a。第三口21c經由第二給排通路6c而連接於氣缸3的第二操作口31b。排氣流路21d連接於未圖示的排氣口。閥芯22在沒有指令電壓被施加於電磁螺線管23時,通過壓縮彈簧24、25而被配置於使第一口21a與第二口21b、第三口21c的任一個都不連通的中立位置。在該狀態下,伺服閥2對第一及第二壓力室32a、32b不進行壓縮空氣的給排氣。在該情況下,氣缸3中,由於在輸出杆34的下端部結合有控制物件9,所以活塞33因控制物件9的重量而下降並抵接於氣缸本體31的下端面。 The first to third ports 21 a to 21 c are opened in the case 21. First mouth 21a It is connected to a compressed air supply source via an input passage 6a. The second port 21b is connected to the first operation port 31a of the cylinder 3 via the first supply / discharge passage 6b. The third port 21c is connected to the second operation port 31b of the cylinder 3 via the second supply / discharge passage 6c. The exhaust flow path 21d is connected to an exhaust port (not shown). When no command voltage is applied to the electromagnetic solenoid 23, the valve element 22 is disposed in a neutral state in which neither of the first port 21a, the second port 21b, or the third port 21c is communicated by the compression springs 24 and 25. position. In this state, the servo valve 2 does not supply or exhaust compressed air to or from the first and second pressure chambers 32a, 32b. In this case, since the control article 9 is coupled to the lower end portion of the output rod 34 in the cylinder 3, the piston 33 is lowered by the weight of the control article 9 and abuts against the lower end surface of the cylinder body 31.
另一方面,閥芯22在指令電壓被施加於電磁螺線管23時,根據該指令電壓朝向第一位置或第二位置移動。在第一位置,第二口21b連通於第一口21a,第三口21c連通于排氣流路21d。在該情況下,氣缸3中,由於向第一壓力室32a供給壓縮空氣,從第二壓力室32b排出壓縮空氣,所以使控制物件9下降。而在第二位置,第三口21c連通於第一口21a,第二口21b連通于排氣流路21d。在該情況下,氣缸3中,由於向第二壓力室32b供給壓縮空氣,從第一壓力室32a排出壓縮空氣,所以使控制物件9上升。另外,伺服閥2通過閥芯22與指令電壓成比例地移動來調整開度,控制壓縮空氣的給排氣量。 On the other hand, when the command voltage is applied to the solenoid 23, the valve element 22 moves toward the first position or the second position according to the command voltage. In the first position, the second port 21b communicates with the first port 21a, and the third port 21c communicates with the exhaust flow path 21d. In this case, in the cylinder 3, since the compressed air is supplied to the first pressure chamber 32a and the compressed air is discharged from the second pressure chamber 32b, the control article 9 is lowered. In the second position, the third port 21c communicates with the first port 21a, and the second port 21b communicates with the exhaust flow path 21d. In this case, since the compressed air is supplied to the second pressure chamber 32b and the compressed air is discharged from the first pressure chamber 32a in the cylinder 3, the control article 9 is raised. In addition, the servo valve 2 adjusts the opening degree by moving the valve element 22 in proportion to the command voltage, and controls the amount of compressed air supplied and exhausted.
位置檢測感測器28檢測出閥芯22的位置。比較部26和調整部27對從控制器5輸出至伺服閥2的指令電壓進行調整,以使得位置檢測感測器28所檢測出的閥芯22的位置 與控制器5的指令一致。 The position detection sensor 28 detects the position of the spool 22. The comparison unit 26 and the adjustment unit 27 adjust the command voltage output from the controller 5 to the servo valve 2 so that the position of the spool 22 detected by the position detection sensor 28 is adjusted. Consistent with the command from the controller 5.
控制器5是公知的微型電腦。控制器5經由位置檢測線7而與位置檢測感測器4電連接,從而能夠被輸入由位置檢測感測器4檢測出的控制物件的位置(檢測位置)。此外,控制器5經由指令電壓輸出線8而連接於伺服閥2,從而能夠將控制伺服閥2動作的指令電壓輸出至伺服閥2。控制器5將示教程式5a和通常動作程式5b存儲在記憶體中。關於示教程式5a和通常動作程式5b的詳細情況將在後說明。 The controller 5 is a known microcomputer. The controller 5 is electrically connected to the position detection sensor 4 via the position detection line 7 so that the position of the control object (detection position) detected by the position detection sensor 4 can be input. The controller 5 is connected to the servo valve 2 via a command voltage output line 8, and can output a command voltage that controls the operation of the servo valve 2 to the servo valve 2. The controller 5 stores the instruction formula 5a and the normal operation program 5b in the memory. Details of the tutorial formula 5a and the normal operation formula 5b will be described later.
氣缸3能夠在物理上使控制物件9下降(伸出)到活塞33抵接於氣缸本體31的下端面(將此時的控制物件9的位置稱為“下端位置”)。此外,氣缸3能夠在物理上使控制物件9上升(後退)到活塞33抵接於氣缸本體31的上端面(將此時的控制物件9的位置稱為“上端位置”)。將該控制物件9的物理上的移動範圍稱為“物理的移動範圍”。但是,伺服氣缸系統1通過對第一及第二壓力室32a、32b的內壓進行調整來驅動氣缸3,從而對控制物件9的位置進行控制。因此,伺服氣缸系統1只能在比物理的移動範圍小的範圍內對控制物件9的位置進行控制。將該控制範圍稱為“可控制範圍”。因此,在以下的說明中,將在壓力室32的壓力下使活塞33向氣缸本體31的下端面側最大限度移動了的時候的控制物件9的位置(可控制範圍中的最低位置、能夠控制成使控制物件9最大程度伸出的位置)稱為“下限位置(最大伸出位置的一例)”,將在壓力室32的壓力下使活塞33向氣缸本體31的上端側最大限度移動了的時候的控制物件9的位置(可控制 範圍中的最高位置、能夠控制成使控制物件9最大程度後退的位置)稱為“上限位置”。 The cylinder 3 can physically lower (extend) the control object 9 until the piston 33 abuts the lower end surface of the cylinder body 31 (the position of the control object 9 at this time is referred to as a "lower end position"). In addition, the cylinder 3 can physically raise (retreat) the control article 9 until the piston 33 abuts the upper end surface of the cylinder body 31 (the position of the control article 9 at this time is referred to as an "upper end position"). The physical movement range of this control object 9 is called "physical movement range". However, the servo cylinder system 1 drives the cylinder 3 by adjusting the internal pressure of the first and second pressure chambers 32 a and 32 b to control the position of the control object 9. Therefore, the servo cylinder system 1 can control the position of the control object 9 only within a range smaller than the physical movement range. This control range is called "controllable range". Therefore, in the following description, the position of the control article 9 (the lowest position in the controllable range, which can be controlled when the piston 33 is moved to the lower end side of the cylinder body 31 to the maximum extent under the pressure of the pressure chamber 32 The position where the control object 9 is extended to the maximum) is called the "lower limit position (an example of the maximum extended position)", and the piston 33 is moved to the upper end side of the cylinder body 31 to the maximum extent under the pressure of the pressure chamber 32. Position of the control object 9 (controllable The highest position in the range and the position that can be controlled so that the control object 9 moves back to the maximum) is called the "upper limit position".
<關於示教動作> <About teaching operation>
下面,基於圖2及圖3對示教動作進行說明。圖2是示教程式5a的流程圖。圖3是說明示教動作的曲線圖,在橫軸示出時間,在左側縱軸示出由位置檢測感測器4檢測出的控制物件9的位置,在右側縱軸示出控制器5輸出至伺服閥2的指令電壓。 The teaching operation will be described below with reference to FIGS. 2 and 3. FIG. 2 is a flowchart showing a tutorial formula 5a. 3 is a graph illustrating a teaching operation, showing time on the horizontal axis, the position of the control object 9 detected by the position detection sensor 4 on the left vertical axis, and the output of the controller 5 on the right vertical axis Command voltage to servo valve 2.
示教動作是通過控制器5執行圖2所示的示教程式5a來進行的。在示教動作中,使伺服氣缸系統1實際運轉來檢測出為了使氣缸3起動而必需的驅動開始指令電壓,並存儲於控制器5。示教動作在電源剛接通後必然進行1次。而且,為了維持產品性能也希望定期地實施。 The teaching operation is performed by the controller 5 executing the teaching formula 5a shown in FIG. 2. In the teaching operation, the servo cylinder system 1 is actually operated to detect a drive start command voltage necessary for starting the cylinder 3 and stored in the controller 5. The teaching operation must be performed immediately after the power is turned on. Moreover, it is desirable to implement it regularly in order to maintain product performance.
控制器5在示教動作開始後首先在圖2的步驟1(以下簡記為“S1”)中使控制物件9向下限位置移動。具體而言,如圖3所示,控制器5輸出指令電壓,使得伺服閥2的閥芯22向第一位置的方向移動。氣缸3中,第一壓力室32a被加壓,第二壓力室32b被減壓,從而控制物件9開始下降。控制器5向伺服閥2輸出指令電壓,以使得控制物件9越是接近下限位置,氣缸3就越減緩控制物件9的下降速度從而使控制物件9高精度地停止在下限位置。 The controller 5 first moves the control object 9 to the lower limit position in step 1 (hereinafter abbreviated as "S1") of FIG. 2 after the teaching operation is started. Specifically, as shown in FIG. 3, the controller 5 outputs a command voltage so that the spool 22 of the servo valve 2 moves in the direction of the first position. In the cylinder 3, the first pressure chamber 32a is pressurized and the second pressure chamber 32b is depressurized, so that the control article 9 starts to descend. The controller 5 outputs a command voltage to the servo valve 2 so that the closer the control object 9 is to the lower limit position, the cylinder 3 slows down the descending speed of the control object 9 to stop the control object 9 at the lower limit position with high accuracy.
然後,在圖2的S2中,控制器5使控制物件9向原點位置(HP)移動。此處,所謂原點位置HP,是指在檢測出驅動開始指令電壓的情況下氣缸3起動的基準位置。在本實 施形態中,以上限位置為原點位置HP。下面具體地說明本處理,如圖3所示,控制器5輸出使伺服閥2的閥芯22向第二位置的方向移動的指令電壓。由此,氣缸3中,由第二壓力室32b的內壓引起的向上的力比由第一壓力室32a的內壓引起的向下的力加上控制物件9的重量而得的力大,因此活塞33與控制物件9一體地上升。 Then, in S2 of FIG. 2, the controller 5 moves the control object 9 to the origin position (HP). Here, the origin position HP refers to a reference position at which the cylinder 3 starts when a drive start command voltage is detected. In this real In this embodiment, the upper limit position is used as the origin position HP. This process will be specifically described below. As shown in FIG. 3, the controller 5 outputs a command voltage for moving the spool 22 of the servo valve 2 in the direction of the second position. Thus, in the cylinder 3, the upward force caused by the internal pressure of the second pressure chamber 32b is greater than the downward force caused by the internal pressure of the first pressure chamber 32a plus the force obtained by controlling the weight of the article 9, Therefore, the piston 33 rises integrally with the control object 9.
如圖2的S3所示,控制器5在控制物件9到達原點位置HP後等待1秒。具體而言,如圖3的S3所示,對控制器5輸入位置檢測感測器4的檢測位置,控制器5在確認控制物件9到達了原點位置HP(上限位置)後,就輸出指令電壓以使控制物件9停止在原點位置HP。由此,指令電壓和控制物件9的位置穩定。另外,該待機時間可以任意地設定。 As shown in S3 of FIG. 2, the controller 5 waits for 1 second after the control object 9 reaches the origin position HP. Specifically, as shown in S3 of FIG. 3, the detection position of the position detection sensor 4 is input to the controller 5, and the controller 5 outputs an instruction after confirming that the control object 9 has reached the origin position HP (upper limit position). The voltage is applied to stop the control object 9 at the origin position HP. Thereby, the command voltage and the position of the control object 9 are stabilized. The standby time can be arbitrarily set.
在圖2的S4中,控制器5使控制物件9開始下降示教規定移動量Z。此處,所謂示教規定移動量Z,是指為了檢測出驅動開始指令電壓而使控制物件9從原點位置HP下降(伸出)及上升(後退)的距離。此外,將控制物件9從原點位置HP移動了示教規定移動量Z而在的位置稱為“示教規定移動位置”。示教規定移動量Z通過後述的方法來確定。在本實施形態中,示教規定移動量Z為4mm。具體而言,如圖3所示,控制器5輸出使伺服閥2的閥芯22向第一位置側移動的指令電壓。在氣缸3中,當第一壓力室32a的內壓所引起的向下的力加上控制物件9的重量而得的力比第二壓力室32b的內壓所引起的向上的力大時,活塞33就與控制物件9一體地開始下降。 In S4 in FIG. 2, the controller 5 starts to lower the control object 9 and teaches the predetermined movement amount Z. Here, the teaching predetermined movement amount Z refers to a distance at which the control object 9 is lowered (extended) and raised (retreated) from the origin position HP in order to detect the drive start command voltage. The position where the control object 9 is moved from the origin position HP by the teaching predetermined movement amount Z is referred to as a "teaching predetermined moving position". The teaching predetermined movement amount Z is determined by a method described later. In this embodiment, the teaching predetermined movement amount Z is 4 mm. Specifically, as shown in FIG. 3, the controller 5 outputs a command voltage for moving the spool 22 of the servo valve 2 to the first position side. In the cylinder 3, when the downward force caused by the internal pressure of the first pressure chamber 32a plus the force obtained by controlling the weight of the article 9 is greater than the upward force caused by the internal pressure of the second pressure chamber 32b, The piston 33 starts to descend integrally with the control object 9.
控制器5在S5中判斷控制物件9是否通過了第一示教位置X1。此處,所謂第一示教位置X1,是指將氣缸3使控制物件9開始下降時控制器5所輸出的指令電壓檢測出的位置。第一示教位置X1被設定在原點位置HP與第一示教規定移動位置之間。第一示教位置X1的確定方法將在後說明。在本實施形態中,從原點位置HP下降了0.7mm而在的位置為第一示教位置X1。 The controller 5 determines whether the control object 9 has passed the first teaching position X1 in S5. Here, the first teaching position X1 is a position where the command voltage output from the controller 5 is detected when the cylinder 3 starts to lower the control object 9. The first teaching position X1 is set between the origin position HP and the first teaching predetermined movement position. The method of determining the first teaching position X1 will be described later. In the present embodiment, the position which has fallen by 0.7 mm from the origin position HP is the first teaching position X1.
如圖2及圖3所示,控制器5在控制物件9通過第一示教位置X1之前(S5:否)不檢測指令電壓,而向伺服閥2輸出使控制物件9下降的指令電壓。而若控制物件9通過了第一示教位置X1(S5:是),則控制器5就在S6中將當前輸出至伺服閥2的指令電壓作為下降用驅動開始指令電壓Y1(驅動開始指令電壓的一例)保存起來。這樣,控制器5使構成該伺服氣缸系統1的氣缸3、伺服閥2、位置檢測感測器4運轉來檢測出氣缸3使控制物件9開始下降時的下降用驅動開始指令電壓Y1並存儲,因此,能夠識別出反映了系統構成部件當時的特性和狀態的下降用驅動開始指令電壓Y1。 As shown in FIG. 2 and FIG. 3, the controller 5 does not detect the command voltage before the control object 9 passes the first teaching position X1 (S5: NO), and outputs the command voltage to the servo valve 2 to lower the control object 9. When the control object 9 passes the first teaching position X1 (S5: YES), the controller 5 uses the command voltage currently output to the servo valve 2 as the drive start command voltage Y1 (drive start command voltage) in S6. An example). In this way, the controller 5 operates the cylinder 3, the servo valve 2, and the position detection sensor 4 constituting the servo cylinder system 1 to detect and store the driving start command voltage Y1 for descent when the cylinder 3 starts to lower the control object 9, Therefore, it is possible to identify the driving start command voltage Y1 for the fall that reflects the characteristics and state of the system components at that time.
然後,控制器5在圖2的S7中判斷控制物件9是否到達了示教規定移動位置。如圖2及圖3所示,在控制物件9到達示教規定移動位置之前(S7:否),控制器5為了讓氣缸3使控制物件9下降而向伺服閥2輸出指令電壓。而當控制器5判斷為控制物件9到達了示教規定移動位置(S7:是)時,則待機4秒。即,控制器5向伺服閥2輸出指令電壓,以使控制物件9在示教規定移動位置停止4秒。由此,指令電壓和控 制物件9的位置穩定。該待機時間可以任意地設定。 Then, the controller 5 determines whether the control object 9 has reached the teaching predetermined movement position in S7 of FIG. 2. As shown in FIGS. 2 and 3, before the control object 9 reaches the teaching predetermined movement position (S7: NO), the controller 5 outputs a command voltage to the servo valve 2 in order for the cylinder 3 to lower the control object 9. When the controller 5 determines that the control object 9 has reached the teaching movement position (S7: YES), it waits for 4 seconds. That is, the controller 5 outputs a command voltage to the servo valve 2 to stop the control object 9 at the teaching movement position for 4 seconds. Therefore, the command voltage and control The position of the manufacturing object 9 is stable. This standby time can be arbitrarily set.
然後,在圖2的S9中,控制器5使控制物件9向著原點位置HP開始上升(後退)。具體而言,如圖3所示,控制器5輸出指令電壓,以使伺服閥2的閥芯22向第二位置側移動。氣缸3中,當第二壓力室32b的內壓所引起的向上的力比第一壓力室32a的內壓所引起的向下的力加上控制物件9的重量而得的力大時,活塞33就與控制物件9一體地開始上升。 Then, in S9 of FIG. 2, the controller 5 causes the control object 9 to start rising (backward) toward the origin position HP. Specifically, as shown in FIG. 3, the controller 5 outputs a command voltage to move the spool 22 of the servo valve 2 to the second position side. In the cylinder 3, when the upward force caused by the internal pressure of the second pressure chamber 32b is larger than the downward force caused by the internal pressure of the first pressure chamber 32a plus the force obtained by controlling the weight of the article 9, the piston 33 starts to rise integrally with the control object 9.
然後,在圖2的S10中,控制器5判斷控制物件9是否通過了第二示教位置X2。此處,所謂第二示教位置X2,是指將氣缸3使控制物件9開始上升時控制器5所輸出的指令電壓檢測出的位置。第二示教位置X2被設定在示教規定移動位置與示教位置HP之間。第二示教位置X2通過後述的確定方法來確定。在本實施形態中,第二示教位置X2為從原點位置HP下降了3.3mm而在的位置(從示教規定移動位置上升了0.7mm而在的位置)。 Then, in S10 of FIG. 2, the controller 5 determines whether the control object 9 has passed the second teaching position X2. Here, the second teaching position X2 is a position where the command voltage output from the controller 5 is detected when the cylinder 3 starts to raise the control object 9. The second teaching position X2 is set between the teaching predetermined movement position and the teaching position HP. The second teaching position X2 is determined by a determination method described later. In this embodiment, the second teaching position X2 is a position that is lowered by 3.3 mm from the origin position HP (a position that is raised by 0.7 mm from the teaching predetermined movement position).
如圖2及圖3所示,控制器5在控制物件9通過第二示教位置X2之前(S10:否)不檢測輸出至伺服閥2的指令電壓,而向伺服閥2輸出用於讓氣缸3使控制物件9上升的指令電壓。而若控制物件9通過了第二示教位置X2(S10:是),則控制器5在S11中檢測出當前輸出至伺服閥2的指令電壓,並將其作為上升用驅動開始指令電壓Y2(驅動開始指令電壓的一例)保存起來。由此,控制器5實際地使用氣缸3、伺服閥2以及位置檢測感測器4來檢測出上升用驅動開始指令電壓 Y2並存儲,因此,能夠識別反映了系統構成部件當時的特性和狀態的上升用驅動開始指令電壓Y2。 As shown in FIGS. 2 and 3, the controller 5 does not detect the command voltage output to the servo valve 2 before the control object 9 passes the second teaching position X2 (S10: NO), and outputs the command voltage to the servo valve 2 for the cylinder 3 A command voltage to raise the control object 9. When the control object 9 passes the second teaching position X2 (S10: YES), the controller 5 detects the command voltage currently output to the servo valve 2 in S11, and uses it as the drive start command voltage Y2 for rising ( An example of the drive start command voltage) is stored. As a result, the controller 5 actually uses the cylinder 3, the servo valve 2, and the position detection sensor 4 to detect the driving start command voltage for ascent. Y2 is also stored, so that it is possible to identify the driving start command voltage Y2 for the rise that reflects the characteristics and status of the system components at that time.
然後,如圖2所示,在S12中,控制器5判斷控制物件9是否到達了原點位置HP。在控制物件9沒有到達原點位置HP的情況下(S12:否),控制器5如圖3所示為了讓氣缸3使控制物件9上升而向伺服閥2持續輸出指令電壓。而如圖2所示,在判斷為控制物件9到達了原點位置HP的情況下(S12:是),結束處理。具體而言,如圖3所示,若位置檢測感測器4經由活塞33檢測出控制物件9的上限位置,則控制器5控制伺服閥2的指令電壓,使得在上限位置停止。在該情況下,氣缸3以將控制物件9配置於原點位置HP(上限位置)的狀態停止。由此,在進行後述的通常動作之時,氣缸3和伺服閥2容易開始動作。 Then, as shown in FIG. 2, in S12, the controller 5 determines whether the control object 9 has reached the origin position HP. When the control object 9 does not reach the origin position HP (S12: No), the controller 5 continuously outputs a command voltage to the servo valve 2 as shown in FIG. 3 in order to make the cylinder 3 raise the control object 9. As shown in FIG. 2, when it is determined that the control object 9 has reached the origin position HP (S12: YES), the processing is terminated. Specifically, as shown in FIG. 3, if the position detection sensor 4 detects the upper limit position of the control object 9 via the piston 33, the controller 5 controls the command voltage of the servo valve 2 to stop at the upper limit position. In this case, the air cylinder 3 is stopped in a state where the control article 9 is disposed at the origin position HP (upper limit position). This makes it easier for the cylinder 3 and the servo valve 2 to start operation when the normal operation described later is performed.
<關於通常動作> <About normal operation>
接下來說明通常動作。控制器5通過執行通常動作程式5b而使控制物件9從當前的位置向目標位置移動。 Next, the normal operation will be described. The controller 5 executes the normal operation program 5b to move the control object 9 from the current position to the target position.
即,如圖9的S21所示,控制器5在例如操作者按下開始開關後接受動作指示。然後,控制器5在S22中確認控制物件9的當前位置。具體而言,對控制器5輸入由位置檢測感測器4經由活塞33檢測出的控制物件9的檢測位置。然後,在S23中,控制器5計算出控制物件9的當前位置與目標位置之間的偏差(從當前位置到目標位置的距離)。然後,控制器5在S24中判斷偏差是否比0大。 That is, as shown in S21 of FIG. 9, the controller 5 receives an operation instruction after the operator presses the start switch, for example. Then, the controller 5 confirms the current position of the control object 9 in S22. Specifically, the controller 5 inputs the detection position of the control object 9 detected by the position detection sensor 4 via the piston 33. Then, in S23, the controller 5 calculates the deviation (the distance from the current position to the target position) between the current position of the control object 9 and the target position. Then, the controller 5 determines whether the deviation is greater than 0 in S24.
控制器5在偏差比0大的情況下(S24:是),在 S25中計算與偏差相應的指令電壓。該指令電壓是僅基於位置檢測感測器4的檢測位置而計算出的,並不反映驅動開始指令電壓。 When the deviation of the controller 5 is greater than 0 (S24: Yes), The command voltage corresponding to the deviation is calculated in S25. This command voltage is calculated based on the detection position of the position detection sensor 4 only, and does not reflect the drive start command voltage.
然後,在S26中,控制器5判斷是否開始動作。具體而言,控制器5通過是否是接受了動作指示之後(參照S1)最先(第一次)的指令電壓控制來進行判斷。控制器5在判斷為本次的控制是開始動作的情況下(S26:是),在S27中判斷是使控制物件9上升還是下降。因為在控制物件9上升的情況和下降的情況,氣缸3實際開始動作時所需要的驅動開始指令電壓(上升用驅動開始指令電壓Y2、下降用驅動開始指令電壓Y1)是不同的,因此需要確認控制物件9移動的方向。 Then, in S26, the controller 5 determines whether the operation is started. Specifically, the controller 5 determines whether it is the first (first time) command voltage control after receiving the operation instruction (see S1). When the controller 5 determines that the current control operation is started (S26: YES), it determines in S27 whether the control object 9 is to be raised or lowered. The drive start command voltage (up drive start command voltage Y2, down drive start command voltage Y1) required when the cylinder 3 actually starts operation is different when the control object 9 is raised and lowered, so it is necessary to confirm Controls the direction in which the object 9 moves.
在使控制物件9上升的情況下(S27:是),控制器5在S28中計算出第二指令電壓,即:將接受到使氣缸3上升的動作指示之後最先(第一次)算出的第一指令電壓與通過示教動作存儲的上升用驅動開始指令電壓Y2相加,從而計算出第二指令電壓。然後,在S29中,控制器5將第二指令電壓輸出至伺服閥2。由此,對伺服閥2,在施加使氣缸3確實開始上升的上升用驅動開始指令電壓Y2的基礎上,在輸入動作指示後又立即施加比第一指令電壓大的第二指令電壓。因此,在氣缸3中,即使構成部件的特性與其他產品不同、或是構成部件劣化,從而僅通過對伺服閥2施加第一指令電壓並不開始上升,也能夠在對伺服閥2施加第二指令電壓時立即開始上升。因此,從第二指令電壓被輸出直到氣缸3使控制物件9開 始上升的回應時間被極力地縮短。之後,返回到S22。 When the control object 9 is raised (S27: YES), the controller 5 calculates the second command voltage in S28, that is, the first (first time) calculation after receiving the instruction to raise the cylinder 3 The first command voltage is added to the rising drive start command voltage Y2 stored by the teaching operation to calculate a second command voltage. Then, in S29, the controller 5 outputs the second command voltage to the servo valve 2. As a result, the servo valve 2 is applied with the drive start command voltage Y2 for raising that actually starts the cylinder 3, and immediately after the operation instruction is input, the second command voltage larger than the first command voltage is applied. Therefore, in the cylinder 3, even if the characteristics of the constituent parts are different from those of other products or the constituent parts are deteriorated, it is possible to apply the second command to the servo valve 2 only by applying the first command voltage to the servo valve 2 without starting to increase. The command voltage starts to rise immediately. Therefore, from the time when the second command voltage is output until the cylinder 3 opens the control object 9 The initial response time was drastically shortened. After that, the process returns to S22.
另一方面,在使控制物件9下降的情況下(S27:否),控制器5在S31中計算出第二指令電壓,即:將為了使氣缸3下降而接受動作指示之後最先(第一次)計算出的第一指令電壓與通過示教動作存儲的下降用驅動開始指令電壓Y1相加,從而計算出第二指令電壓。然後,在S29中,控制器5將第二指令電壓輸出至伺服閥2。由此,對伺服閥2,在施加使氣缸3確實地開始下降的下降用驅動開始指令電壓Y1的基礎上,又施加比第一指令電壓大的第二指令電壓。因此,在氣缸3中,即使構成部件的特性與其他產品不同、或是構成部件劣化,從而僅通過對伺服閥2施加第一指令電壓並不開始下降,也能夠在對伺服閥2施加第二指令電壓時立即開始下降。因此,從第二指令電壓被輸出直到氣缸3使控制物件9下降的回應時間被極力地縮短。之後,返回到S22。 On the other hand, when the control object 9 is lowered (S27: No), the controller 5 calculates the second command voltage in S31, that is, the controller 5 first receives the operation instruction in order to lower the cylinder 3 (first Times) The calculated first command voltage is added to the driving start command voltage Y1 for descent stored by the teaching operation to calculate a second command voltage. Then, in S29, the controller 5 outputs the second command voltage to the servo valve 2. As a result, the servo valve 2 is applied with the second drive voltage higher than the first command voltage in addition to the lowering drive start command voltage Y1 that starts the cylinder 3 to reliably descend. Therefore, in the cylinder 3, even if the characteristics of the constituent parts are different from those of other products or the constituent parts are deteriorated, the second command can be applied to the servo valve 2 only by applying the first command voltage to the servo valve 2 without starting to decrease. The command voltage starts to drop immediately. Therefore, the response time from when the second command voltage is output until the cylinder 3 lowers the control object 9 is extremely shortened. After that, the process returns to S22.
控制器5返回到S22,使控制物件9向著目標位置移動。具體而言,控制器5在S22~S24中求出控制物件9的當前位置與目標位置之間的偏差,並判斷偏差是否比0大。由於在控制物件9沒有到達目標位置的情況下,偏差比0大(S24:是),所以控制器5在S25中計算出與檢測位置和目標位置之間的偏差相應的指令電壓。在該時點,由於氣缸3處於開始動作之後,而不是開始動作(不是輸入動作指示之後最先的指令電壓控制)(S26:否),所以在S30中,將在S25中計算出的指令電壓保持原樣直接作為第二指令電壓輸出至伺服閥2。之後返回到S22。通過反復進行該處理,控制物件 9向著目標位置移動。即,控制器5在氣缸3開始動作之後,與公知技術同樣地基於位置檢測感測器4所檢測出的檢測位置對控制物件9的位置進行回饋控制。當控制物件9到達目標位置,控制物件9的當前位置與目標位置之間的偏差為0(S24:否)時,控制器5結束處理。 The controller 5 returns to S22 and moves the control object 9 toward the target position. Specifically, the controller 5 determines the deviation between the current position of the control object 9 and the target position in S22 to S24, and determines whether the deviation is greater than 0. Since the deviation is greater than 0 when the control object 9 does not reach the target position (S24: YES), the controller 5 calculates a command voltage corresponding to the deviation between the detection position and the target position in S25. At this point in time, since the cylinder 3 is after the start operation, rather than the start operation (not the first command voltage control after the input of the operation instruction) (S26: No), the command voltage calculated in S25 is held in S30. As it is, the second command voltage is directly output to the servo valve 2. Then return to S22. By repeating this process, the object is controlled 9Move towards the target position. That is, after the cylinder 3 starts operating, the controller 5 performs feedback control on the position of the control object 9 based on the detection position detected by the position detection sensor 4 in the same manner as the known technique. When the control object 9 reaches the target position and the deviation between the current position of the control object 9 and the target position is 0 (S24: NO), the controller 5 ends the process.
<關於在示教動作時使控制物件9向下限位置移動之後又向原點位置HP移動的理由> <The reason for moving the control object 9 to the lower limit position during the teaching operation and then to the origin position HP>
如圖2的S1、S2所示,示教程式5a使控制物件9一度向下限位置移動之後又向原點位置HP(上限位置)移動。這是為了在示教動作時讓氣缸3使控制物件9以短時間穩定地移動至原點位置HP。基於圖4對此具體說明。圖4是說明因控制物件的移動開始位置的差別所引起的氣缸移動方式不同的圖。 As shown in S1 and S2 of FIG. 2, the instruction formula 5a moves the control object 9 to the lower limit position once and then moves to the origin position HP (upper limit position). This is to allow the air cylinder 3 to move the control object 9 to the origin position HP stably for a short time during the teaching operation. This will be specifically described based on FIG. 4. FIG. 4 is a diagram illustrating a difference in a cylinder movement method due to a difference in a movement start position of a control object.
如圖4(a)所示,氣缸3如圖中P1所示在使控制物件9從上端位置向原點位置HP移動的情況下,如圖中P2所示使控制物件9下降得超過原點位置HP。然後,氣缸3如圖中P3所示使控制物件9向著原點位置HP上升之後,使控制物件9穩定於原點位置HP。 As shown in FIG. 4 (a), when the cylinder 3 moves the control object 9 from the upper end position to the origin position HP as shown in P1 in the figure, the control object 9 is lowered beyond the origin position as shown in P2 in the figure HP. Then, the air cylinder 3 raises the control object 9 toward the origin position HP as shown in P3 in the figure, and then stabilizes the control object 9 at the origin position HP.
此外,例如圖4(b)所示,氣缸3如圖中P11所示在使控制物件9從原點位置HP與下限位置之間的位置向原點位置HP移動的情況下,如圖中P12所示,使控制物件9上升得超過原點位置HP。然後,氣缸3如圖中P13所示,使控制物件9向著原點位置HP下降之後,使控制物件9穩定於原點位置HP。 In addition, for example, as shown in FIG. 4 (b), when the cylinder 3 moves the control object 9 from the position between the original position HP and the lower limit position to the original position HP as shown in P11 in the figure, as shown in P12 As shown, the control object 9 is raised beyond the origin position HP. Then, as shown in P13 in the figure, the air cylinder 3 lowers the control object 9 toward the origin position HP, and then stabilizes the control object 9 at the origin position HP.
再例如圖4(c)所示,氣缸3如圖中P21所示在 使控制物件9從下限位置移動的情況下,由於存在對於進行穩定的控制而言足夠的距離,所以能夠降低超調量,使控制物件9儘快地穩定於原點位置HP。 As another example, as shown in FIG. 4 (c), the cylinder 3 is shown in FIG. When the control object 9 is moved from the lower limit position, since there is a sufficient distance for stable control, the amount of overshoot can be reduced, and the control object 9 can be stabilized at the origin position HP as quickly as possible.
因此,在示教動作時,若使控制物件向下限位置移動之後又向原點位置HP移動,則能夠降低使控制物件9到達原點位置HP時的超調量,使之儘快地到達並穩定於原點位置HP。 Therefore, during the teaching operation, if the control object is moved to the lower limit position and then moved to the origin position HP, the amount of overshoot when the control object 9 reaches the origin position HP can be reduced, so that it reaches and stabilizes as soon as possible. Origin position HP.
<關於示教規定移動量及示教位置的確定方法> <How to determine the teaching movement amount and teaching position>
接下來,參照圖5~圖8來說明示教規定移動量及示教位置的確定方法。首先對確定示教規定移動量及示教位置的必要性進行說明。 Next, a method for determining the teaching predetermined movement amount and the teaching position will be described with reference to FIGS. 5 to 8. First, the necessity of determining the prescribed movement amount and teaching position will be explained.
發明者們關於1個伺服氣缸系統1針對第一事例、第二事例以及第三事例執行示教程式5a,進行實驗以調查控制器5所輸出的指令電壓的變動,其中,第一事例是以示教動作開始時控制物件9的位置為上端位置;第二事例是以示教動作開始時控制物件9的位置為上端位置與下端位置之間的中間位置;第三事例是以示教動作開始時控制物件9的位置為下端位置。其結果如圖5所示。圖5是說明因示教動作開始時控制物件的位置的差別所引起的上升用及下降用驅動開始指令電壓的不同的圖,在橫軸示出時間,在左側縱軸示出控制物件9的位置,在右側縱軸示出控制器5向伺服閥2輸出的指令電壓。 The inventors performed tutorial formula 5a on one servo cylinder system 1 for the first case, the second case, and the third case, and conducted experiments to investigate the variation of the command voltage output by the controller 5. The first case is The position of the control object 9 at the beginning of the teaching action is the upper position; the second case is the position of the control object 9 at the beginning of the teaching action as the middle position between the upper end position and the lower end position; the third example is the start of the teaching action The position of the time control object 9 is the lower end position. The results are shown in Fig. 5. FIG. 5 is a diagram illustrating the difference between the driving start command voltage for ascent and descent caused by the difference in the position of the control object at the start of the teaching operation, the time is shown on the horizontal axis, and the control object 9 is shown on the left vertical axis. The position indicates the command voltage output from the controller 5 to the servo valve 2 on the right vertical axis.
如圖5所示,第一~第三事例中,根據示教動作開始時控制物件9的位置而在控制物件9的位置變動和指令電 壓的變動上產生差別。 As shown in FIG. 5, in the first to third examples, the position of the control object 9 is changed and the electric signal is commanded according to the position of the control object 9 when the teaching operation is started. There is a difference in pressure fluctuations.
圖6是圖5的A部放大圖。如圖中實線所示,在第一事例中,控制物件9從原點位置HP下降到第一示教位置X1時的指令電壓Y11為5.225V。如圖中虛線所示,在第二事例中,控制物件9從原點位置HP下降到第一示教位置X1時的指令電壓Y12為5.177V。如圖中雙點劃線所示,在第三事例中,控制物件9從原點位置HP下降到第一示教位置X1時的指令電壓Y13為5.110V。可見,根據示教動作開始時控制物件9的位置,在下降用驅動開始指令電壓Y11~Y13中產生0.115V的差。 FIG. 6 is an enlarged view of part A of FIG. 5. As shown by the solid line in the figure, in the first example, the command voltage Y11 when the control object 9 descends from the origin position HP to the first teaching position X1 is 5.225V. As shown by the dotted line in the figure, in the second example, the command voltage Y12 when the control object 9 descends from the origin position HP to the first teaching position X1 is 5.177V. As shown by the two-dot chain line in the figure, in the third example, the command voltage Y13 when the control object 9 is lowered from the origin position HP to the first teaching position X1 is 5.110V. It can be seen that according to the position of the control object 9 at the start of the teaching operation, a difference of 0.115 V occurs in the driving start command voltages Y11 to Y13 for descent.
此外,如圖中細實線所示,在第一事例中,控制物件9從示教規定移動位置上升到第二示教位置X2時的指令電壓Y21為4.140V。如圖中細虛線所示,在第二事例中,控制物件9從示教規定移動位置上升到第二示教位置X2時的指令電壓Y22為4.125V。如圖中細的雙點劃線所示,在第三事例中,控制物件9從示教規定移動位置上升到第二示教位置X2時的指令電壓Y23為4.135V。可見,根據示教動作開始時控制物件9的位置,在上升用驅動開始指令電壓Y21~Y23中產生0.015V的差。 In addition, as shown by the thin solid line in the figure, in the first example, the command voltage Y21 when the control object 9 rises from the teaching predetermined movement position to the second teaching position X2 is 4.140V. As shown by the thin dashed line in the figure, in the second example, the command voltage Y22 when the control object 9 rises from the teaching prescribed movement position to the second teaching position X2 is 4.125V. As shown by the thin two-dot chain line in the figure, in the third example, the command voltage Y23 when the control object 9 rises from the teaching prescribed movement position to the second teaching position X2 is 4.135V. It can be seen that according to the position of the control object 9 at the start of the teaching operation, a difference of 0.015 V occurs in the drive start command voltages Y21 to Y23 for ascent.
這樣,示教動作因示教動作開始時控制物件9的位置的差別而產生下降用驅動開始指令電壓Y1的差別和上升用驅動開始指令電壓Y2的差別。若該下降用驅動開始指令電壓Y1的差別和上升用驅動開始指令電壓Y2的差別大,則在通常動作時,有無法改善氣缸3起動時的回應性的擔心。具體 而言,若在通常動作開始時控制物件9位於上端位置,則不將根據第一事例而存儲的下降用驅動開始指令電壓Y11(5.225V)輸出至伺服閥2,氣缸3就不開始下降。但是,在根據第三事例進行示教動作的情況下,對於在通常動作開始時將控制物件9配置於上端位置的氣缸3,即使控制器5將下降指令開始電壓Y13(5.110V)輸出至伺服閥2,也是指令電壓不足,氣缸3無法回應性良好地開始下降。由此,希望使根據控制物件9的位置而產生的下降用驅動開始指令電壓Y1的差別和上升用驅動開始指令電壓Y2的差別極力地減小。這是為了降低根據示教動作開始時控制物件9的位置而在通常動作時氣缸3起動時候的回應性不均這一情況。 In this way, the teaching operation causes a difference in the driving start command voltage Y1 for the lowering and a driving start command voltage Y2 for the raising due to the difference in the position of the control object 9 at the start of the teaching operation. If the difference between the driving start command voltage Y1 for falling and the driving start command voltage Y2 for rising is large, there is a concern that the response at the start of the cylinder 3 cannot be improved during normal operation. specific In other words, if the control object 9 is located at the upper end position when the normal operation is started, the descending drive start command voltage Y11 (5.225 V) stored according to the first example is not output to the servo valve 2 and the cylinder 3 does not start descending. However, when the teaching operation is performed based on the third example, the cylinder 3 with the control object 9 placed at the upper end position at the start of the normal operation, even if the controller 5 outputs the descending command start voltage Y13 (5.110V) to the servo The valve 2 also had insufficient command voltage, and the cylinder 3 could not respond well and began to fall. For this reason, it is desirable to minimize the difference between the driving start command voltage Y1 for lowering and the driving start command voltage Y2 for raising caused by the position of the control object 9 as much as possible. This is to reduce unevenness in response when the cylinder 3 is started during normal operation depending on the position of the control object 9 at the start of the teaching operation.
因此,發明者們以使得在示教動作時根據控制物件9的位置而產生的下降用驅動開始指令電壓Y1的差別和上升用驅動開始指令電壓Y2的差別減小的方式確定示教規定移動量Z和第一及第二示教位置X1、X2。基於圖7及圖8來說明該確定方法。 Therefore, the inventors determined the teaching predetermined movement amount so that the difference between the driving start command voltage Y1 for descent and the driving start command voltage Y2 for descent caused by the position of the control object 9 during the teaching operation was reduced. Z and the first and second teaching positions X1, X2. This determination method will be described based on FIGS. 7 and 8.
首先,說明確定示教規定移動量的方法。發明者們進行示教規定移動量試驗,以調查示教規定移動量Z與下降用驅動開始指令電壓Y1和上升用驅動開始指令電壓Y2之間的關係。在示教規定移動量試驗中,除了示教動作開始時控制物件9的位置不同的點和示教規定移動量Z不同的點,以相同的示教動作測定下降用驅動開始指令電壓Y1和上升用驅動開始指令電壓Y2。 First, a method of determining a predetermined movement amount will be described. The inventors conducted a teaching predetermined movement amount test to investigate the relationship between the teaching predetermined movement amount Z and the driving start command voltage Y1 for falling and the driving start command voltage Y2 for rising. In the teaching prescribed movement amount test, except for a point where the position of the control object 9 is different at the start of the teaching action and a point where the teaching prescribed movement amount Z is different, the driving start command voltage Y1 for falling and the rising are measured by the same teaching action. The drive start command voltage Y2 is used.
在該試驗中,原點位置HP為上限位置的點、第一 示教位置X1為從原點位置HP下降了0.7mm而在的位置的點、第二示教位置X2為從原點位置HP下降了3.3mm而在的位置(從示教規定移動位置上升了0.7mm而在的位置)的點是共用的。而在示教動作開始時控制物件9的位置為上端位置、為上端位置與下端位置之間的中間位置、為下端位置的點,則是不同的。此外,在示教規定移動量Z為1mm、2mm、3mm、4mm、5mm、6mm的點,是不同的。 In this test, the origin position HP is the point of the upper limit position, the first The teaching position X1 is a point that is lowered by 0.7 mm from the origin position HP, and the second teaching position X2 is a position that is lowered by 3.3 mm from the origin position HP (rising from the teaching predetermined movement position The point at 0.7mm is common. At the beginning of the teaching operation, the position of the control object 9 is the upper end position, the middle position between the upper end position and the lower end position, and the point at which the lower end position is. In addition, the points at which the prescribed movement amount Z is 1 mm, 2 mm, 3 mm, 4 mm, 5 mm, and 6 mm are different.
在試驗中,按各示教規定移動量Z,測定:示教動作開始時控制物件9的位置為上端位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2、示教動作開始時控制物件9的位置為中間位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2、以及示教動作開始時控制物件9的位置為下端位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2。然後,按各示教規定移動量Z,計算出基於控制物件9的位置的下降用驅動開始指令電壓Y1的差和上升用驅動開始指令電壓Y2的差。其結果如圖7所示。 In the test, according to the predetermined movement amount Z of each teaching, it is measured: when the position of the control object 9 is at the upper end position when the teaching operation starts, the driving start command voltage Y1 for falling and the driving start command voltage Y2 for rising are taught Lowering drive start command voltage Y1 and rising drive start command voltage Y2 when the position of the control object 9 is at the middle position at the beginning and lowering drive start when the position of the control object 9 is the lower end position when the teaching operation starts The command voltage Y1 and the rising drive start command voltage Y2. Then, the difference between the driving start command voltage Y1 for descent and the driving start command voltage Y2 for ascent based on the position of the control object 9 is calculated for each teaching movement amount Z. The results are shown in Fig. 7.
如圖7所示,在示教規定移動量為1mm的情況下,下降用驅動開始指令電壓Y1的差為0.173V,上升用驅動開始指令電壓Y2的差為0.136V。在示教規定移動量為2mm的情況下,下降用驅動開始指令電壓Y1的差為0.096V,上升用驅動開始指令電壓Y2的差為0.037V。在示教規定移動量為3mm的情況下,下降用驅動開始指令電壓Y1的差為0.047V,上升用驅動開始指令電壓Y2的差為0.014V。在示教規定移動量為 4mm的情況下,下降用驅動開始指令電壓Y1的差為0.033V,上升用驅動開始指令電壓Y2的差為0.006V。在示教規定移動量為5mm的情況下,下降用驅動開始指令電壓Y1的差為0.036V,上升用驅動開始指令電壓Y2的差為0.005V。在示教規定移動量為6mm的情況下,下降用驅動開始指令電壓Y1的差為0.034V,上升用驅動開始指令電壓Y2的差為0.007V。 As shown in FIG. 7, when the teaching prescribed movement amount is 1 mm, the difference between the driving start command voltage Y1 for falling is 0.173V, and the difference for the driving start command voltage Y2 for rising is 0.136V. When the teaching prescribed movement amount is 2 mm, the difference between the driving start command voltage Y1 for falling is 0.096V, and the difference for the driving start command voltage Y2 for rising is 0.037V. When the teaching prescribed movement amount is 3 mm, the difference between the driving start command voltage Y1 for falling is 0.047V, and the difference for the driving start command voltage Y2 for rising is 0.014V. The amount of movement required during teaching is In the case of 4 mm, the difference between the driving start command voltage Y1 for the descent is 0.033V, and the difference between the driving start command voltage Y2 for the ascent is 0.006V. When the teaching prescribed movement amount is 5 mm, the difference between the driving start command voltage Y1 for falling is 0.036V, and the difference for the driving start command voltage Y2 for rising is 0.005V. When the teaching prescribed movement amount is 6 mm, the difference between the driving start command voltage Y1 for descent is 0.034V, and the difference for the driving start command voltage Y2 for ascent is 0.007V.
由此,在示教規定移動量Z為1mm以上但不足4mm的範圍中,下降用驅動開始指令電壓Y1的差(實線)和上升用驅動開始指令電壓Y2的差(虛線)都顯示出減少傾向。而若示教規定移動量Z為4mm以上,則下降用驅動開始指令電壓Y1的差(實線)和上升用驅動開始指令電壓Y2的差(虛線)都穩定了。由此,通過使示教規定移動量Z為4mm以上,能夠使根據示教動作開始時控制物件9的位置而產生的下降用驅動開始指令電壓Y1的差和上升用驅動開始指令電壓Y2的差都減小。 As a result, the difference (solid line) between the driving start command voltage Y1 for falling and the difference (dashed line) for the driving start command voltage Y2 for ascent are reduced in a range where the teaching prescribed movement amount Z is 1 mm or more but less than 4 mm. tendency. On the other hand, when the predetermined movement amount Z is 4 mm or more, the difference (solid line) between the driving start command voltage Y1 for falling and the difference (dashed line) for the driving start command voltage Y2 for rising are stabilized. Accordingly, by setting the predetermined movement amount Z of teaching to 4 mm or more, it is possible to make a difference between the driving start command voltage Y1 for descent and the driving start command voltage Y2 for descent according to the position of the object 9 at the start of the teaching operation. Are reduced.
接下來說明確定第一及第二示教位置X1、X2的方法。發明者們進行示教位置試驗,以調查第一及第二示教位置X1、X2與指令電壓之間的關係。在示教位置試驗中,除了使控制物件9向原點位置HP移動之前位置不同的點以及示教位置不同的點,以相同的示教動作檢測出下降用驅動開始指令電壓Y1和上升用驅動開始指令電壓Y2。 Next, a method for determining the first and second teaching positions X1 and X2 will be described. The inventors conducted a teaching position test to investigate the relationship between the first and second teaching positions X1 and X2 and the command voltage. In the teaching position test, except for the point where the control object 9 was moved to the origin position HP and the point where the teaching position is different, the lower driving start command voltage Y1 and the rising driving start were detected by the same teaching operation. Command voltage Y2.
在該試驗中,原點位置HP為上限位置的點和示教規定移動量Z為4mm的點是共用的。而第一示教位置X1為從原點位置HP下降了0.4mm、0.5mm、0.6mm、0.7mm、0.8mm、 0.9mm而在的位置的點、第二示教位置X2為從示教規定移動位置上升了0.4mm、0.5mm、0.6mm、0.7mm、0.8mm、0.9mm而在的位置(從原點位置HP下降了3.6mm、3.5mm、3.4mm、3.3mm、3.2mm、3.1mm而在的位置)的點則是不同的。 In this test, the point where the origin position HP is the upper limit position and the point where the teaching movement amount Z is 4 mm are common. The first teaching position X1 is 0.4mm, 0.5mm, 0.6mm, 0.7mm, 0.8mm, The point at the position of 0.9mm and the second teaching position X2 are the positions (from the origin position) which have risen by 0.4mm, 0.5mm, 0.6mm, 0.7mm, 0.8mm, 0.9mm from the teaching movement position. HP drops by 3.6mm, 3.5mm, 3.4mm, 3.3mm, 3.2mm, 3.1mm) is different.
在試驗中,按第一及第二示教位置X1、X2,測定:示教動作開始時控制物件9的位置為上端位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2、示教動作開始時控制物件9的位置為中間位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2、以及示教動作開始時控制物件9的位置為下端位置情況下的下降用驅動開始指令電壓Y1及上升用驅動開始指令電壓Y2。然後,按第一及第二示教位置X1、X2,計算出下降用驅動開始指令電壓Y1的差和上升用驅動開始指令電壓Y2的差。其結果如圖8所示。 In the test, the first and second teaching positions X1 and X2 were used to measure: when the position of the control object 9 at the start of the teaching operation is the upper end position, the driving start command voltage Y1 for descent and the driving start command voltage Y2 for ascent , When the position of the control object 9 at the start of the teaching operation is the intermediate position, the driving start command voltage Y1 for lowering and the driving start command voltage Y2 for the rising operation, and when the position of the control object 9 is the lower end position when the teaching operation starts The driving start command voltage Y1 for falling and the driving start command voltage Y2 for rising are. Then, the difference between the driving start command voltage Y1 for falling and the driving start command voltage Y2 for rising are calculated at the first and second teaching positions X1 and X2. The results are shown in Fig. 8.
如圖8所示,在第一示教位置X1為從原點位置HP下降了0.4mm而在的位置、第二示教位置X2為從示教規定移動位置上升了0.4mm而在的位置,下降用驅動開始指令電壓Y1的差為0.054V,上升用驅動開始指令電壓Y2的差為0.007V。在第一示教位置X1從原點位置HP下降了0.5mm而在的位置、第二示教位置X2從示教規定移動位置上升了0.5mm而在的位置,下降用驅動開始指令電壓Y1的差為0.044V,上升用驅動開始指令電壓Y2的差為0.006V。在第一示教位置X1從原點位置HP下降了0.6mm而在的位置、第二示教位置X2從示教規定移動位置上升了0.6mm而在的位置,下降用驅動開始指令電壓Y1的差為0.036V,上升用驅動開始 指令電壓Y2的差為0.005V。在第一示教位置X1從原點位置HP下降了0.7mm而在的位置、第二示教位置X2從示教規定移動位置上升了0.7mm而在的位置,下降用驅動開始指令電壓Y1的差為0.030V,上升用驅動開始指令電壓Y2的差為0.007V。在第一示教位置X1從原點位置HP下降了0.8mm而在的位置、第二示教位置X2從示教規定移動位置上升了0.8mm而在的位置,下降用驅動開始指令電壓Y1的差為0.029V,上升用驅動開始指令電壓Y2的差為0.006V。在第一示教位置X1從原點位置HP下降了0.9mm而在的位置、第二示教位置X2從示教規定移動位置上升了0.9mm而在的位置,下降用驅動開始指令電壓Y1的差為0.030V,上升用驅動開始指令電壓Y2的差為0.007V。 As shown in FIG. 8, the first teaching position X1 is a position lowered by 0.4 mm from the origin position HP, and the second teaching position X2 is a position raised by 0.4 mm from a predetermined movement position. The difference between the driving start command voltage Y1 for falling is 0.054V, and the difference for the driving start command voltage Y2 for rising is 0.007V. At the position where the first teaching position X1 is lowered by 0.5 mm from the original position HP and the position where the second teaching position X2 is raised by 0.5 mm from the predetermined movement position, the driving start command voltage Y1 for the lowering is The difference is 0.044V, and the difference between the rising drive start command voltage Y2 is 0.006V. At the position where the first teaching position X1 has fallen by 0.6 mm from the origin position HP and the second teaching position X2 has been raised by 0.6 mm from the teaching predetermined movement position, the driving start command voltage Y1 for the descent The difference is 0.036V, and the rising drive starts The difference between the command voltage Y2 is 0.005V. At the position where the first teaching position X1 is lowered by 0.7 mm from the original position HP and the position where the second teaching position X2 is raised by 0.7 mm from the predetermined movement position, the driving start command voltage Y1 for the lowering is The difference is 0.030V, and the difference between the rising drive start command voltage Y2 is 0.007V. At the position where the first teaching position X1 is lowered by 0.8 mm from the origin position HP and the position where the second teaching position X2 is raised by 0.8 mm from the predetermined movement position, the driving start command voltage Y1 for the lowering is The difference is 0.029V, and the difference between the rising drive start command voltage Y2 is 0.006V. At the position where the first teaching position X1 is lowered by 0.9 mm from the original position HP and the position where the second teaching position X2 is raised by 0.9 mm from the predetermined movement position, the driving start command voltage Y1 is lowered. The difference is 0.030V, and the difference between the rising drive start command voltage Y2 is 0.007V.
由此,若使第一示教位置X1離原點位置HP為0.4mm以上但不足0.7mm,則下降用驅動開始指令電壓Y1的差(實線)顯示出減少傾向。但是,若使第一示教位置X1為從原點位置HP下降0.7mm以上而在的位置,則下降用驅動開始指令電壓Y1的差(實線)穩定。由此,通過使第一示教位置X1為從原點位置HP下降了0.7mm以上而在的位置,能夠使根據示教動作開始時控制物件9的位置而產生的下降用驅動開始指令電壓Y1的差小。 Therefore, if the first teaching position X1 is set to be 0.4 mm or more but less than 0.7 mm from the origin position HP, the difference (solid line) of the driving start command voltage Y1 for lowering tends to decrease. However, when the first teaching position X1 is lowered by 0.7 mm or more from the origin position HP, the difference (solid line) of the driving start command voltage Y1 for lowering is stabilized. Thus, by lowering the first teaching position X1 to a position where the first teaching position X1 is lowered by 0.7 mm or more, the driving start command voltage Y1 for descent which is generated by controlling the position of the object 9 at the start of the teaching operation can be made. The difference is small.
而上升用驅動開始指令電壓Y2的差(虛線)並沒有隨第二示教位置X2的不同而被看出大的差。由此,第二示教位置X2可以根據第一示教位置X1自由地確定。因此,為了使控制容易,使第二示教位置X2為從示教規定移動位置上 升了與從原點位置HP到第一示教位置的距離相同的距離的位置為好。 On the other hand, the difference (dotted line) in the drive start command voltage Y2 for rising is not seen as a large difference depending on the second teaching position X2. Thereby, the second teaching position X2 can be freely determined based on the first teaching position X1. Therefore, in order to make the control easy, the second teaching position X2 is moved from the teaching predetermined movement position. It is preferable to raise the position by the same distance as the distance from the origin position HP to the first teaching position.
這樣,示教規定移動量Z與第一及第二示教位置X1、X2被確定成使得在示教動作開始時根據控制物件9的位置而產生的下降用驅動開始指令電壓Y1和上升用驅動開始指令電壓Y2的差變小(穩定)。因此,即使示教動作開始時控制物件9的位置不同,也能夠使下降用驅動開始指令電壓Y1和上升用驅動開始指令電壓Y2的差變小。因此,不論進行示教動作時控制物件9的位置在哪裡,在對伺服閥2輸出下降用驅動開始指令電壓Y1的基礎上又輸入比第一指令電壓大的第二指令電壓時,從輸出第二指令電壓時到氣缸3使控制物件9開始下降時的回應時間的不均都能夠減小。此外,不論進行示教動作時控制物件9的位置在哪裡,在對伺服閥2輸出上升用驅動開始指令電壓Y2的基礎上又輸入第二指令電壓時,從輸出第二指令電壓時到氣缸3使控制物件9開始上升時的回應時間的不均都能夠減小。 In this way, the teaching predetermined movement amount Z and the first and second teaching positions X1 and X2 are determined so that the driving start command voltage Y1 for lowering and the driving for ascending generated according to the position of the control object 9 at the start of the teaching operation. The difference in the start command voltage Y2 becomes smaller (stable). Therefore, even if the position of the control object 9 is different at the start of the teaching operation, the difference between the driving start command voltage Y1 for lowering and the driving start command voltage Y2 for rising can be made small. Therefore, irrespective of the position of the control object 9 during the teaching operation, when a second drive command voltage greater than the first command voltage is input to the servo valve 2 and the drive start command voltage Y1 for falling is input, the output from the first The variation in response time from the time of the two command voltages to the time when the cylinder 3 starts to lower the control object 9 can be reduced. In addition, regardless of the position of the control object 9 when the teaching operation is performed, when the second command voltage is input in addition to the drive start command voltage Y2 for rising to the servo valve 2, the second command voltage is output to the cylinder 3 Any variation in response time when the control object 9 starts to rise can be reduced.
<關於作用效果> <About effect>
如以上說明的那樣,本實施形態中,伺服氣缸系統1具有:氣缸3,其根據壓力室32的壓力而使控制物件9沿直線方向進退;伺服閥2,其對壓力室32進行壓縮空氣的給排氣;位置檢測感測器4(位置檢測單元的一例),其檢測控制物件9的位置;及控制器5,其輸入位置檢測感測器4所檢測出的檢測位置,求出與目標位置之間的偏差,並基於偏差向伺服閥2輸出指令電壓,該伺服氣缸系統1的特徵在於:控制器5具有示教 程式5a(示教單元的一例)和通常動作程式5b(尤其是圖9的S26~S29、S31、起動時電壓調整單元的一例),在示教程式5a中,向伺服閥2輸出指令電壓以使控制物件9從規定的原點位置HP移動(使下降到示教規定移動位置之後又從示教規定移動位置上升到原點位置HP),檢測出控制物件9通過從原點位置HP離開規定量的示教位置{從原點位置HP向下降側離開第一規定量(0.7mm)的第一示教位置X1、及從原點位置HP向下降側離開第二規定量(3.3mm)(從示教規定移動位置向上升側離開0.7mm)的第二示教位置X2}時的指令電壓,並將其作為驅動開始指令電壓(下降用驅動開始指令電壓Y1、上升用驅動開始指令電壓Y2)存儲;在通常動作程式5b中,在輸入了使控制物件9從當前的位置向目標位置移動的動作指示的情況下,將驅動開始指令電壓(下降用驅動開始指令電壓Y1或上升用驅動開始指令電壓Y2)與輸入動作指示後最先基於偏差計算出的第一指令電壓相加而計算出第二指令電壓,並將第二指令電壓輸出至伺服閥2。 As described above, in the present embodiment, the servo cylinder system 1 includes the cylinder 3 that advances and retreats the control object 9 in a linear direction according to the pressure of the pressure chamber 32, and the servo valve 2 that compresses the pressure chamber 32. Air supply and exhaust; position detection sensor 4 (an example of a position detection unit) that detects the position of the control object 9; and controller 5 that inputs the detection position detected by the position detection sensor 4 to obtain a target The deviation between the positions, and a command voltage is output to the servo valve 2 based on the deviation. The servo cylinder system 1 is characterized in that the controller 5 has teaching Program 5a (an example of the teaching unit) and normal operation program 5b (especially S26 to S29, S31 in Figure 9 and an example of the voltage adjustment unit at startup). The control object 9 is moved from the predetermined origin position HP (after being lowered to the teaching predetermined movement position and then raised from the teaching predetermined movement position to the origin position HP), and it is detected that the control object 9 has left the predetermined position from the origin position HP Teaching position {the first teaching position X1, which is a predetermined distance (0.7 mm) from the origin position HP toward the lower side, and the second predetermined amount (3.3 mm) from the origin position HP toward the lower side ( The command voltage when the second teaching position X2} is 0.7 mm away from the prescribed movement position to the rising side) and used as the drive start command voltage (driving start command voltage Y1 for descent, driving start command voltage Y2 for ascent ) Stored: In the normal operation program 5b, when an operation instruction to move the control object 9 from the current position to the target position is input, the drive start command voltage (the drive start command voltage Y1 for falling or the drive for rising start is started) (Command voltage Y2) After entering the first operation instruction based on the deviation of the calculated first voltage command is calculated by adding a second command voltage, and outputs a second command voltage to the servo valve 2.
在上述實施形態的伺服氣缸系統1中,控制器5通過執行示教程式5a而使伺服氣缸系統1的構成部件實際運轉並向伺服閥2輸出指令電壓,使控制物件9從原點位置HP移動(下降到示教規定移動位置後又從示教規定移動位置上升到原點位置HP)。此時,控制器5檢測控制物件9通過從原點位置HP以規定量離開的示教位置{從原點位置HP向下降側離開第一規定量(0.7mm)的第一示教位置X1、及從原點位置HP向下降側離開第二規定量(3.3mm)(從示教規定移動 位置向上升側離開0.7mm)的第二示教位置X2}時的指令電壓,並將其作為驅動開始指令電壓(下降用驅動開始指令電壓Y1或上升用驅動開始指令電壓Y2)存儲。因此,驅動開始指令電壓為該伺服氣缸系統1能夠使氣缸3確實地起動(開始下降或者開始上升)的值。 In the servo cylinder system 1 of the above embodiment, the controller 5 executes the instruction formula 5a to actually operate the components of the servo cylinder system 1 and outputs a command voltage to the servo valve 2 to move the control object 9 from the origin position HP. (After descending to the teaching prescribed movement position, it rises from the teaching prescribed moving position to the origin position HP). At this time, the controller 5 detects the teaching position 9 where the control object 9 is separated from the origin position HP by a predetermined amount {the first teaching position X1 that is separated from the origin position HP by a first predetermined amount (0.7 mm) toward the lower side. And a second predetermined amount (3.3mm) away from the origin position HP toward the lower side (moving from the teaching regulations The command voltage at the second teaching position X2} whose position is 0.7 mm away from the rising side) is stored as a drive start command voltage (driving start command voltage Y1 for falling or driving start command voltage Y2 for rising). Therefore, the drive start command voltage is a value at which the servo cylinder system 1 can surely start the cylinder 3 (begin to descend or start to rise).
控制器5在輸入了使控制物件9從當前的位置向目標位置移動的動作指示的情況下,基於位置檢測感測器4所檢測出的檢測位置與目標位置的偏差向伺服閥2輸出指令電壓。此時,控制器5根據通常動作程式5b的S26~S29、S31(參照圖9),將通過上述的示教動作而存儲的驅動開始指令電壓(下降用驅動開始指令電壓Y1或上升用驅動開始指令電壓Y2)與在輸入動作指示之後最先基於偏差計算出的第一指令電壓相加,由此計算出第二指令電壓,並將該第二指令電壓輸出至伺服閥2。氣缸3由於被施加比第一指令電壓大的第二指令電壓,所以當向伺服閥2輸出第二指令電壓時立即起動,使控制物件9從當前的位置向著目標位置開始移動。氣缸3和伺服閥2在起動時需要大的力,但是在起動後則容易順暢地動作。因此,伺服氣缸系統1在氣缸3起動之後,根據控制器5基於檢測位置與目標位置之間的偏差輸出的指令電壓,使控制物件9向目標位置移動。 When the controller 5 inputs an operation instruction to move the control object 9 from the current position to the target position, the controller 5 outputs a command voltage to the servo valve 2 based on the deviation between the detected position detected by the position detection sensor 4 and the target position. . At this time, based on S26 to S29 and S31 (refer to FIG. 9) of the normal operation program 5b, the controller 5 sets the driving start command voltage (driving start command voltage Y1 for falling or driving start for rising) stored by the teaching operation described above. The command voltage Y2) is added to the first command voltage calculated first based on the deviation after the operation instruction is input, thereby calculating a second command voltage and outputting the second command voltage to the servo valve 2. Since the second command voltage larger than the first command voltage is applied to the cylinder 3, when the second command voltage is output to the servo valve 2, the cylinder 3 is immediately started to move the control object 9 from the current position toward the target position. The cylinder 3 and the servo valve 2 require a large force at the time of starting, but it is easy to operate smoothly after starting. Therefore, after the cylinder 3 is started, the servo cylinder system 1 moves the control object 9 to the target position based on the command voltage output by the controller 5 based on the deviation between the detected position and the target position.
這樣,在上述構成的伺服氣缸系統1中,當輸入了動作指示,就向伺服閥2輸出比最先僅基於偏差計算出的第一指令電壓大的第二指令電壓,因此,即使構成伺服氣缸系統1的氣缸3、伺服閥2等構成部件的特性在產品之間存在不同、 或經長時間而劣化,也能夠使氣缸3回應性良好地起動(開始下降或開始上升)。因此,上述構成的伺服氣缸系統1能夠根據產品的特性和劣化狀態來改善回應性,能夠使位置控制性能在產品間均勻化,並且能夠維持初始的位置控制性能。 In this way, in the servo cylinder system 1 configured as described above, when an operation instruction is input, a second command voltage larger than the first command voltage calculated based on the deviation first based on the deviation is output to the servo valve 2 even if the servo cylinder is configured. The characteristics of the components such as the cylinder 3 and the servo valve 2 of the system 1 differ between products, Or it can degrade over a long period of time, and it is possible to start the cylinder 3 responsively (begin to descend or start to rise). Therefore, the servo cylinder system 1 configured as described above can improve the responsiveness according to the characteristics and deterioration state of the product, can uniformize the position control performance among the products, and can maintain the initial position control performance.
此外,在本實施形態的伺服氣缸系統1中,示教程式5a將示教位置(第一或第二示教位置X1、X2)設定在根據向原點位置HP移動之前控制物件9的位置而產生的驅動開始指令電壓(下降用驅動開始指令電壓Y1、上升用驅動開始指令電壓Y2)的差小的範圍內。因此,不論示教動作開始時控制物件9停止在哪個位置,通過示教動作檢測出的驅動開始指令電壓(下降用驅動開始指令電壓Y1或上升用驅動開始指令電壓Y2)之差都小。因此,不論進行示教動作時控制物件9的位置在何處,在使控制物件9向目標位置移動的情況下,都能夠向伺服閥輸出比輸入動作指示後最先僅基於偏差計算出的第一指令電壓大的第二指令電壓,來使氣缸3立即起動(開始下降或開始上升)。由此,根據本實施形態的伺服氣缸系統1,即使不根據控制物件9的位置來改變示教動作和通常動作的控制,也能夠改善響應性。 In addition, in the servo cylinder system 1 of the present embodiment, the teaching formula 5a sets the teaching position (the first or second teaching positions X1 and X2) to be generated based on the position of the control object 9 before moving to the origin position HP. The difference between the driving start command voltages (driving start command voltage Y1 for rising and driving start command voltage Y2 for rising) is small. Therefore, regardless of where the control object 9 stops at the start of the teaching operation, the difference between the driving start command voltages (driving start command voltage Y1 for falling or driving start command voltage Y2 for rising) detected by the teaching operation is small. Therefore, no matter where the position of the control object 9 is when the teaching operation is performed, when the control object 9 is moved to the target position, it is possible to output to the servo valve the first position calculated based on the deviation after inputting the operation instruction. A second command voltage having a large command voltage causes the cylinder 3 to start immediately (begins to descend or start to rise). Therefore, according to the servo cylinder system 1 of the present embodiment, the response can be improved without changing the control of the teaching operation and the normal operation according to the position of the control object 9.
此外,在本實施形態的伺服氣缸系統1中,示教程式5a具有準備單元(參照圖2的S1、S2),該準備單元在使控制物件9向原點位置HP移動之前,向伺服閥2輸出指令電壓,以使控制物件9移動至作為最大程度伸出(下降)位置的最大伸出位置(下限位置)。由此,伺服氣缸系統1由於具有對於示教動作時進行穩定的控制來說足夠的距離,所以,與 使控制物件9從最大伸出位置(下限位置)以外的位置到達原點位置HP的情況相比,能夠降低超調量,從而能夠使控制物件9儘快地到達原點位置HP。由此,根據本實施形態的伺服氣缸系統1,能夠使控制物件9以短時間高精度地到達原點位置HP。 In addition, in the servo cylinder system 1 of the present embodiment, the tutorial formula 5a includes a preparation unit (refer to S1 and S2 in FIG. 2), and the preparation unit outputs to the servo valve 2 before moving the control object 9 to the origin position HP. The voltage is commanded to move the control object 9 to the maximum extended position (lower limit position), which is the maximum extended (lowered) position. Therefore, since the servo cylinder system 1 has a sufficient distance for stable control during teaching operation, Compared with the case where the control object 9 is reached from a position other than the maximum extension position (lower limit position) to the origin position HP, the amount of overshoot can be reduced, so that the control object 9 can reach the origin position HP as quickly as possible. Thus, according to the servo cylinder system 1 of this embodiment, the control object 9 can reach the origin position HP with high accuracy in a short time.
因此,根據本實施形態的伺服氣缸系統1,能提供能夠改善氣缸3起動時的回應性、能夠謀求位置控制性能的均勻化及其維持的伺服氣缸系統1。 Therefore, according to the servo cylinder system 1 of this embodiment, it is possible to provide the servo cylinder system 1 which can improve the responsiveness at the time of starting of the cylinder 3 and can achieve uniformity of position control performance and maintenance thereof.
另外,本發明並不限於上述實施形態,能夠進行各種應用。 The present invention is not limited to the above-mentioned embodiments, and can be applied to various applications.
(1)例如,在上述實施形態中,由從活塞33的位置檢測出控制物件9的位置的位置檢測感測器4構成位置檢測單元。但位置檢測單元也可以檢測輸出杆34的位置或是壓力室32的壓力從而檢測出控制物件9的位置,還可以直接檢測出控制物件9的位置。此外,位置檢測單元也可以構成為通過感測器檢測氣缸3的活塞33的位置、壓力室32的壓力、輸出杆34的位置,並將其檢測結果輸出至控制器5,控制器5由檢測結果計算出控制物件9的位置。 (1) For example, in the above-described embodiment, the position detection unit is configured by the position detection sensor 4 that detects the position of the control object 9 from the position of the piston 33. However, the position detection unit may also detect the position of the output lever 34 or the pressure of the pressure chamber 32 to detect the position of the control object 9, and may also directly detect the position of the control object 9. In addition, the position detection unit may be configured to detect the position of the piston 33 of the cylinder 3, the pressure of the pressure chamber 32, and the position of the output lever 34 by a sensor, and output the detection result to the controller 5, which is detected by the controller 5. As a result, the position of the control object 9 is calculated.
(2)例如,在上述實施形態中,通過1個伺服閥2控制向第一及第二壓力室32a、32b供給的壓縮空氣。但也可以在第一操作口31a和第二操作口31b上分別各設置1個給排氣閥,通過這一對給排氣閥構成伺服閥。 (2) For example, in the above-mentioned embodiment, the compressed air supplied to the first and second pressure chambers 32a, 32b is controlled by one servo valve 2. However, each of the first operation port 31a and the second operation port 31b may be provided with one air supply and exhaust valve, and a servo valve may be formed by the pair of air supply and exhaust valves.
(3)例如,在上述實施形態中,示教程式5a向伺服閥2輸出指令電壓,以使控制物件9向下限位置移動之後 又向原點位置HP移動,但是,也可以向伺服閥2輸出指令電壓,以使控制物件9向下限位置以外的位置〔例如上限位置、比下限位置略微(例如0.1mm)靠上的位置等〕移動之後又向原點位置移動。 (3) For example, in the above-mentioned embodiment, the instruction formula 5a outputs a command voltage to the servo valve 2 to move the control object 9 to the lower limit position. Move to the origin position HP again, but it is also possible to output a command voltage to the servo valve 2 so that the control object 9 is at a position other than the lower limit position (for example, the upper limit position, a position slightly higher than the lower limit position (for example, 0.1 mm), etc.) After moving to the origin position.
在上述實施形態中,氣缸3被配置成使輸出杆34朝下突出。但氣缸3也可以被配置成使輸出杆34朝上突出,還可以被配置成使輸出杆34沿水準方向往復運動。 In the above embodiment, the air cylinder 3 is arranged so that the output lever 34 projects downward. However, the air cylinder 3 may be configured so that the output lever 34 projects upward, and may also be configured so that the output lever 34 reciprocates in a horizontal direction.
在上述實施形態中,是通過1次示教動作檢測出下降用及上升用驅動開始指令電壓並存儲,但是,下降用驅動開始指令電壓和上升用驅動開始指令電壓也可以通過不同的示教動作檢測出並存儲。 In the above-mentioned embodiment, the driving start command voltage for falling and rising is detected and stored by one teaching operation, but the driving start command voltage for falling and the driving start command voltage for rising may be taught by different teaching operations. Detected and stored.
在上述實施形態中,使原點位置HP為上限位置,但是,只要在可控制範圍內,原點位置HP可以設定在任意的位置(例如下限位置、上限位置與下限位置之間的中間位置等)。在該情況下,與本實施形態一樣,在示教動作時易於對控制物件9的位置進行控制。 In the above embodiment, the origin position HP is set to the upper limit position, but the origin position HP can be set at any position as long as it is within the controllable range (for example, the lower limit position, the intermediate position between the upper limit position and the lower limit position, etc. ). In this case, as in the present embodiment, it is easy to control the position of the control object 9 during teaching operations.
Claims (3)
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016023401A JP6404842B2 (en) | 2016-02-10 | 2016-02-10 | Servo cylinder system |
JP2016-023401 | 2016-02-10 |
Publications (2)
Publication Number | Publication Date |
---|---|
TW201729020A TW201729020A (en) | 2017-08-16 |
TWI631440B true TWI631440B (en) | 2018-08-01 |
Family
ID=59598252
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
TW106100810A TWI631440B (en) | 2016-02-10 | 2017-01-11 | Servo cylinder system |
Country Status (4)
Country | Link |
---|---|
JP (1) | JP6404842B2 (en) |
KR (1) | KR101925204B1 (en) |
CN (1) | CN107061383B (en) |
TW (1) | TWI631440B (en) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115635222A (en) * | 2022-11-09 | 2023-01-24 | 珠海格力智能装备有限公司 | Lantern ring control method, lantern ring control system and storage medium |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW353129B (en) * | 1996-04-19 | 1999-02-21 | Futaba Denshi Kogyo Kk | Fuel injection device for a model engine, and a model engine having such fuel injection device |
TW200305503A (en) * | 2002-04-26 | 2003-11-01 | Komatsu Mfg Co Ltd | Die height adjusting device for pressing machine |
TWM452550U (en) * | 2012-09-21 | 2013-05-01 | Ya De Li Technology Inc | Intelligent motor controller, tag-on circuit and remote control thereof |
TWI471499B (en) * | 2010-11-29 | 2015-02-01 | Lincoln Ind Corp | Pump having stepper motor and overdrive control |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS57192603A (en) * | 1981-05-23 | 1982-11-26 | Shoketsu Kinzoku Kogyo Co Ltd | Fluid pressure cylinder control device |
US5585053A (en) * | 1994-04-15 | 1996-12-17 | Nissei Plastic Industrial Co., Ltd. | Method of controlling a movable member in a molding machine |
JP3851137B2 (en) * | 2001-10-26 | 2006-11-29 | Smc株式会社 | High speed driving method and apparatus for pressure cylinder |
JP2003305573A (en) * | 2002-04-11 | 2003-10-28 | Chuo Seisakusho Ltd | Pressure device for electric resistance welding machine |
JP4200284B2 (en) * | 2003-03-20 | 2008-12-24 | Smc株式会社 | High speed driving method and system for pressure cylinder |
JP2004295747A (en) * | 2003-03-28 | 2004-10-21 | Sumitomo Heavy Ind Ltd | Origin determining method of hydraulic actuator, and control program for the same |
JP4687944B2 (en) * | 2004-03-30 | 2011-05-25 | Smc株式会社 | Air servo gun cylinder for welding and control method thereof |
JP2006130523A (en) * | 2004-11-04 | 2006-05-25 | Fanuc Ltd | Die cushion mechanism, and controller and control method therefor |
-
2016
- 2016-02-10 JP JP2016023401A patent/JP6404842B2/en active Active
-
2017
- 2017-01-11 TW TW106100810A patent/TWI631440B/en active
- 2017-01-12 CN CN201710022582.7A patent/CN107061383B/en active Active
- 2017-02-07 KR KR1020170016625A patent/KR101925204B1/en active IP Right Grant
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
TW353129B (en) * | 1996-04-19 | 1999-02-21 | Futaba Denshi Kogyo Kk | Fuel injection device for a model engine, and a model engine having such fuel injection device |
TW200305503A (en) * | 2002-04-26 | 2003-11-01 | Komatsu Mfg Co Ltd | Die height adjusting device for pressing machine |
TWI471499B (en) * | 2010-11-29 | 2015-02-01 | Lincoln Ind Corp | Pump having stepper motor and overdrive control |
TWM452550U (en) * | 2012-09-21 | 2013-05-01 | Ya De Li Technology Inc | Intelligent motor controller, tag-on circuit and remote control thereof |
Also Published As
Publication number | Publication date |
---|---|
CN107061383A (en) | 2017-08-18 |
KR101925204B1 (en) | 2018-12-04 |
KR20170094501A (en) | 2017-08-18 |
TW201729020A (en) | 2017-08-16 |
CN107061383B (en) | 2018-11-20 |
JP2017141884A (en) | 2017-08-17 |
JP6404842B2 (en) | 2018-10-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8033801B2 (en) | Liquid chemical supply system and liquid chemical supply control device | |
KR101856578B1 (en) | Bellows pump device | |
US7938994B2 (en) | Method of controlling an injection molding machine | |
KR20160140923A (en) | Method and device for operating a pressure reservoir, in particular for common rail injection systems in automobile engineering | |
TWI631440B (en) | Servo cylinder system | |
WO2017187687A1 (en) | Raising/lowering control device for work vehicle | |
JP4698577B2 (en) | Linear compressor control system, linear compressor control method, linear compressor and cooling system | |
KR20210139160A (en) | Valve device, system and method | |
US10113564B2 (en) | Hydraulic system and method of operating the same | |
KR102190562B1 (en) | Piezoelectric dispenser | |
JP2016109022A (en) | Bellows pump device | |
JP6734704B2 (en) | Bellows pump device | |
JP2002276611A (en) | Hydraulic operation system, sheet metal working machine and industrial machine | |
EP1009578B1 (en) | Apparatus andfor and methof of welding or reflow soldering with automatically adjusted pressure | |
US11920580B2 (en) | Bellows pump device | |
WO2022004349A1 (en) | Fluid control device, fluid supply system, and fluid supply method | |
US20240044325A1 (en) | Bellows pump device | |
CN111306045B (en) | Bellows pump device | |
US12104588B2 (en) | Low hysteresis piezo-electric pump | |
JP2008223550A (en) | Liquid supply system | |
CN115962122A (en) | Bellows pump device | |
JP2024506134A (en) | pneumatic cylinder system | |
CN111946882A (en) | Adjusting end-of-travel position of process control valve |