EP1124668A1 - A device and a method for controlling the motion of a pneumatic actuator - Google Patents
A device and a method for controlling the motion of a pneumatic actuatorInfo
- Publication number
- EP1124668A1 EP1124668A1 EP99946554A EP99946554A EP1124668A1 EP 1124668 A1 EP1124668 A1 EP 1124668A1 EP 99946554 A EP99946554 A EP 99946554A EP 99946554 A EP99946554 A EP 99946554A EP 1124668 A1 EP1124668 A1 EP 1124668A1
- Authority
- EP
- European Patent Office
- Prior art keywords
- piston
- control
- robot arm
- control means
- signal
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 21
- 238000013178 mathematical model Methods 0.000 claims abstract description 18
- 239000000725 suspension Substances 0.000 claims description 23
- 238000012067 mathematical method Methods 0.000 claims description 4
- 210000002445 nipple Anatomy 0.000 description 11
- 238000009434 installation Methods 0.000 description 4
- 210000000481 breast Anatomy 0.000 description 2
- 230000001419 dependent effect Effects 0.000 description 2
- 238000002474 experimental method Methods 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004140 cleaning Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 210000003608 fece Anatomy 0.000 description 1
- 230000001939 inductive effect Effects 0.000 description 1
- 239000010871 livestock manure Substances 0.000 description 1
- 238000011089 mechanical engineering Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000035945 sensitivity Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01J—MANUFACTURE OF DAIRY PRODUCTS
- A01J5/00—Milking machines or devices
- A01J5/017—Automatic attaching or detaching of clusters
- A01J5/0175—Attaching of clusters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/14—Programme-controlled manipulators characterised by positioning means for manipulator elements fluid
- B25J9/144—Linear actuators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/43—Programme-control systems fluidic
- G05B19/44—Programme-control systems fluidic pneumatic
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45113—Animal handling, milking robot
Definitions
- the present invention relates to a method for controlling the motion of a pneumatic actuator, according to the preamble of claim 1, and an apparatus to perform the method according to the preamble of claim 6.
- An apparatus making such control is known from Design and testing of a servo controller for pneumatic cylinders, 1989, Journal of Process Mechanical Engineering, p 21-27.
- a jerky motion of the pneumatic device and an unstable motion of the robot arm is not desirable while the robot arm must perform a smooth movement in three dimensions.
- control means comprising algorithms implicated for performing a motion of a pneumatic device with a closed-loop do not include any satisfactory mathematical model with determined parameters obtained from data collected in an experiment.
- a method as initially defined which is characterized by providing for each elongated cylinder deterministically moving designs i.e. way of movement of the piston, providing a mathematical model in said control means for providing a control design system which controls in a closed loop system a momentary movement of said piston for each moving design based on at least one signal from the sensor means regarding the piston feature, and generating a control signal from said control means to move said piston in accordance with an instant portion of the actual movin" desi-m.
- the pneumatic actuator can be controlled in a smooth, even and exact movement.
- said design system in said control means comprises an algorithm with a system identification technique adapted for an automatic external influence from the mathematical model.
- the pneumatic actuator can be controlled in a smooth performance and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing said pneumatic components.
- said piston feature signal fed to the control means comprises a position signal indicating the actual position of said piston, providing said mathematical method estimating at least one parameter in co-operation with a closed one-loop system in said control means, providing said model based control design system in said control means including an algorithm with a system identification technique adapted for an external influence from said mathematical model, said operation signal and said position signal, and generating said control signal from said first control means for said piston to be moved in accordance with the instant portion of said design system.
- the pneumatic actuator can be controlled in a smooth, even and exact performance according to the position signal and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing the pneumatic components.
- said piston feature signal comprises a pressure difference signal indicating the actual pressure difference between said first and second chambers, providing said mathematical method estimating at least one parameter in co-operation with a closed two-loop system in said control means; providing a model based control design system in said control means including an algorithm with a system identification technique adapted for an external influence from said mathematical model, said operation signal and said piston feature signal, and generating said control signal from said second control means for said piston to be moved in accordance with the instant portion of said design system.
- the pneumatic actuator can be controlled in a smooth, even and exact performance according to the pressure difference signal and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing the pneumatic components.
- comparing said position signal with said pressure difference signal by said control means comprises a comparing algorithm for generating a control signal depending on the actual piston feature.
- the pneumatic actuator can be controlled by the external operation signals by either said first piston feature signal or a second piston feature signal or both of said signals depending on which desirable operations the pneumatic actuator has to perform.
- control means is provided with determmistically moving designs; said control means comprises a mathematical model for providing a control design system for controlling in a closed loop system a momentary movement of said piston for each moving design based on said at least one piston feature signal; and said control means is adapted to move said piston in accordance with an instant portion of the actual moving design.
- said first piston feature signal can be fed to said model based control design system adapted in a one-loop control means.
- said sensor means comprises a differential pressure transductor adapted to sense the pressure difference between the said first and second chambers and co- operating with said control means for controlling said piston relatively to said cylinder.
- both the first piston feature signal and the second piston feature signal can be fed to said model based control design system adapted in a two-loop control means.
- a valve means is associated with said control means and connectable to said first and second chambers: and said valve means operates to control said piston relatively to said cylinder.
- the piston relatively to the cylinder can be controlled as the valve means controls the pressure into the chambers of the cylinder.
- a first pressure supply line is connectable between said first chamber and said valve means, and a second pressure supply line is connectable between said second chamber and said valve means.
- the pneumatic pressure may have an effect on the piston relatively to the cylinder in at least one direction.
- At least two pneumatic actuators are provided in an operating system
- a co- ordinator means common for the actuators, is associated with said control means in said control devices in the operating system in order to provide a coordinated operation of them.
- a robot arm can be controlled with a good controllability and in an efficient manner.
- an apparatus for performing an animal related operation having said robot arm, wherein said robot arm is steered by at least two pneumatic actuators each comprising said control device for controlling the motion of said robot arm.
- said robot arm is steered by at least two pneumatic actuators each comprising said control device for controlling the motion of said robot arm.
- said apparatus comprises a co-ordinator means for co-operating with said control device in each of the pneumatic actuators, and said co-ordinator means is adapted to control said control devices in a coordinated operation.
- the robot arm can be moved in a co-ordinated smooth, even and exact operation.
- said robot arm is connected to a robot arm suspension means, which is furthermore hingedly connected to a support means, and said robot arm suspension means being arranged to said support means about an essential horizontal axis, and at least one of said control devices is arranged between said robot arm suspension means and said support means, for allowing said robot suspension means to perform a substantially pendulum movement about said essential horizontal axis (X-X).
- X-X essential horizontal axis
- At least one of said control devices is arranged between said robot arm and said support means, for actively moving said robot arm in a substantially vertical plane.
- a controllable pendulum movement is achieved.
- said robot arm is pivotally connected to said robot arm suspension means, for allowing said robot arm to perform a pivotal movement in relation to said robot arm suspension means.
- said robot arm is pivotally connected to said robot arm suspension means, for allowing said robot arm to perform a pivotal movement in relation to said robot arm suspension means.
- At least one of said pneumatic actuators is arranged between said robot arm and said robot arm suspension means, for actively moving said robot arm in a substantially sideward direction.
- a controllable pivotal movement is achieved.
- said robot arm suspension means comprises a pivot means having a bar movable about a substantially horizontal axis, said bar being provided with a first connection member for said robot arm and a second connection member for said at least one of said pneumatic actuators, each of said first and second connection members being provided with a hinge movable about a substantially vertical axis.
- a joint for the pivotal movement is achieved.
- Figure 1 illustrates a control device according to a first embodiment of the invention
- Figure 2 illustrates a control device according to a second embodiment of the invention
- Figure 3 illustrates a co-ordinator means associated with three control devices for coordinating at least two of said control devices
- Figure 4 illustrates an apparatus for performing an animal related operation arranged with the pneumatic actuators 3a, 3b, 3c.
- a pneumatic device 2 comprises a pneumatic cylinder 6 provided with a piston 4 connected to a piston rod 8.
- a first pressure line 10 is connected to a first chamber 5 a of a cylinder 6 and to a servo valve 20.
- a second pressure line 12 is connected to a second chamber 5b of the cylinder 6 and to the servo valve 20.
- the servo valve 20 may be a 5/3 proportional flow control valve, and is controlled by a first control unit 22a controlling the valve 20.
- the valve 20 operates to control the movement of the piston 4 inside the cylinder 6.
- the servo valve 20 is connected to a pressure source 16 by a supply line 14 and is controlled by the unit 22a to feed the pressure of the source 16 to one or the other of the chambers 5a and 5b.
- a position sensor 23 is adapted to the cylinder 6 for sensing the position of the piston 4.
- the position sensor 23 provides a position signal 103 and is connected to the first control unit 22a, which furthermore is connected to the servo valve 20 and to a co- ordinator unit 100.
- An operation signal 101 is fed to the control unit 22a from the coordinator unit 100.
- the co-ordinator unit 100 is arranged to co-ordinate for example three pneumatic actuators 3 a, 3 b, 3 c mounted to a robot arm 38 of a milking robot. The robot arm will be further described bellow in connection with fig. 4.
- the output of the sensor 23 is fed to the control unit 22a, which for example can be an ordinary kind of computer, with an one-loop implication and which controls the operation of the pneumatic actuator 3. It is possible to have the position sensor 23 to directly indicate the speed of the piston 4, i.e. the position per unit of time. However, it is also possible to have the position as an output and provide the speed indication by for example the sampling rate of an analog-to-digital converter (not shown) converting the analog reading of the sensor 23 into digital values fed to the unit 22a.
- the control unit 22a comprises a mathematical model 105 with determined parameters obtained from data collected experimentally. This mathematical model is automatically activated by the algorithm arranged with a system identification technique.
- An operation signal 101 is fed to the control unit 22a from a co-ordinator unit 100, which will be described further bellow.
- the control unit 22a generates a control signal 102 to the servo valve 20 for controlling the actuator 3.
- the position sensor 23 may be a linear potentiometer inside or outside the cylinder 6 or a linear inductive contactless sensor. Also may at least one optical incremental encoder, rotary potentiometer or rotary incremental or absolute encoder, adapted on a robot arm. be used, which will be further described bellow in connection with fig. 4.
- Figure 2 shows an example of a second embodiment of the invention, in which parts denoted with a reference sign correspond to parts of the first embodiment with the same reference sign.
- the protection device thus includes a differential pressure transductor 30, which is provided in a first connection line 31 between the two chambers 5 a and 5b, and in practice connects the first pressure supply line 10 and the second supply pressure line 12. Furthermore the second embodiment includes a control unit 22b, which is connected to the servo valve 20, to the position sensor 23 and to the differential pressure transductor 30.
- the transductor 30 is adapted between the first and second chambers 5 a. 5b of the cylinder 6 for sensing the pressure difference between the chambers.
- the transductor 30 provides a pressure difference signal 104 to the control unit 22 b.
- the outputs of the transductor 30 and the sensor 23 are fed to the control unit 22b, which for example can be an ordinary kind of computer, with a two-loop implication and which controls the operation of the pneumatic actuator 3.
- the control unit 22b comprises a mathematical model 105' with determined parameters obtained from data collected in an experiment.
- the mathematical model 105' is more complicated than the model 105 in the first embodiment, since it is dependent by two detected signals, the instant position of the piston and the pressure difference between the chambers 5a and 5b and gives a more defined movement indication for the control of the piston movement.
- Said operation signal 101 is fed to the control unit 22b from said co-ordinator unit 100 and a signal is of course fed from the co-ordinator unit 100 to the control unit 22b.
- the co-ordinator unit 100 operates to steer at least two pneumatic actuators in a coordinated smooth motion. This will further be described in fig.3
- Said mathematical model 105' is automatically activated by the algorithm arranged with a system identification technique.
- the control unit 22b generates a control signal 102 to the servo valve 20 for steering the piston motion in said cylinder 6.
- Figure 3 shows an example of an embodiment wherein the co-ordinator unit 100 is connected to a first, a second and a third control device 2a, 2b, 2c.
- the co-ordinator unit 100 can for example be an ordinary kind of computer.
- the co-ordinator means provides operation signals 101a. 101b, 101c to the control devices 2a, 2b, 2c and operates to co-ordinate the control devices 2a, 2b, 2c for controlling for example a robot arm 38, to make a smooth, exact and even movement along an indicated path.
- a robot arm 38 is connected to a robot arm suspension means 40.
- the robot arm suspension means 40 is hingedly connected to a support means 42 and is arranged to said support means 42 about a horizontal axis
- Said robot arm (38) is steered by said actuators (3) comprising said control device (2)
- the support means 42 is connected to a railing 50 of an animal stall 60.
- the robot arm 38 is pivotally connected to the robot arm suspension means 40.
- a first pneumatic actuator 3 a is arranged between the robot arm suspension means 40 and the support means 42.
- a second pneumatic actuator 3b is arranged between the robot arm 38 and said support means 42.
- a third pneumatic actuator 3 c is arranged between the robot arm 38 and the robot arm suspension means 40.
- the robot arm 38 is connected to the suspension means 40 via a pivot means 44, including a tubular member 47. movable about a pair of hinge members 46a, 46b, the tubular member 47 forming a substantially horizontal axis A-A. and furthermore via said third pneumatic actuator 3c connected to the tubular member 47 of the pivot means 44.
- the first, second and third pneumatic actuator 3 a, 3b, 3c could be connected to a common control unit (not shown) or separately to its own special control units 22a, 22b (shown in respectively fig.l and 2).
- control units 22a, 22b furthermore can be connected to a co-ordinator unit 100 (not shown), which, for example, may be an ordinary kind of computer.
- At least one optical incremental or absolute encoder, rotary potentiometer or rotary incremental encoder, adapted on a robot arm. may be used (not shown) separately or in combination with the position sensor.
- the control device according to the invention can be arranged for controlling many different functions. It is an advantage to combine a position sensor means 23 with a differential pressure transductor 30 as the transductor 30 can give the robot arm a sensitivity for detecting obstacle or if, for example, the animal comes in a wrong position.
- the force applied to the robot arm is controllable.
- the cleaner can be pushed towards the udder of the animal with a controllable force.
- an animal to be milked such as a cow
- the differential pressure transductor 30, as illustrated in figure 2 may be used as an alternative to or in combination with the position sensor 23.
- a teat cup (not shown) connected to the robot arm 38 is moved towards a teat of the animal, the teat cup is attached onto the teat in response to said differential pressure transductor 30 for permitting a safe motion towards the teat.
- the controller shall be adjusted according to the new installed robot system.
- the parameters for controlling the control device according to the invention can be adjusted automatically.
- This automatic parameter tuning operates to adjust the control signal, even if changes of the position features of the piston arises caused by wear and tear in valves or cylinders, altered data caused by friction, change of temperature e.t.c.
- the pneumatic actuators 3 can be controlled in a smooth motion and have a good precision.
- the algorithm implies that the robot arm can be moved in a smooth motion.
Landscapes
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Animal Husbandry (AREA)
- Environmental Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
- Actuator (AREA)
- Fluid-Pressure Circuits (AREA)
Abstract
A method for controlling the motion of a pneumatic actuator (3), comprising at least one elongated cylinder (6) provided with a piston (4), dividing the cylinder (6) into a first chamber (5a) and a second chamber (5b), an actuating pressure supply line (14) connectable to at least one of said first and second chambers (5a, 5b), a control means (22a, 22b) for controlling the motion of the piston (4) relatively to the cylinder (6), and at least one sensor means (23, 30) adapted to sense a piston feature related to the piston motion and co-operating with the control means (22a, 22b). According to the invention a control device is provided with deterministically moving designs for the piston (4), a mathematical model (105, 105') in said control means (22a, 22b) for providing a control design system for controlling in a closed loop system a momentary movement of said piston (4) for each moving design based on said at least one piston feature signal, and generating a control signal (102) from said control means (22a, 22b) to move said piston (4) in accordance with an instant portion of the actual moving design.
Description
A device and a method for controlling the motion of a pneumatic actuator
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a method for controlling the motion of a pneumatic actuator, according to the preamble of claim 1, and an apparatus to perform the method according to the preamble of claim 6. An apparatus making such control is known from Design and testing of a servo controller for pneumatic cylinders, 1989, Journal of Process Mechanical Engineering, p 21-27.
A jerky motion of the pneumatic device and an unstable motion of the robot arm is not desirable while the robot arm must perform a smooth movement in three dimensions.
The repetition of a closed-loop system implemented in a control means is according to known technique not satisfactory and has an inadequate precision.
Known control means comprising algorithms implicated for performing a motion of a pneumatic device with a closed-loop do not include any satisfactory mathematical model with determined parameters obtained from data collected in an experiment.
SUMMARY OF THE INVENTION
This has been solved by a method as initially defined, which is characterized by providing for each elongated cylinder deterministically moving designs i.e. way of movement of the piston, providing a mathematical model in said control means for providing a control design system which controls in a closed loop system a momentary movement of said piston for each moving design based on at least one signal from the sensor means regarding the piston feature, and generating a control signal from said control means to move said piston in accordance with an instant portion of the actual movin" desi-m.
Hereby the pneumatic actuator can be controlled in a smooth, even and exact movement.
Preferably, said design system in said control means comprises an algorithm with a system identification technique adapted for an automatic external influence from the mathematical model. Hereby the pneumatic actuator can be controlled in a smooth performance and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing said pneumatic components.
Suitably, said piston feature signal fed to the control means, comprises a position signal indicating the actual position of said piston, providing said mathematical method estimating at least one parameter in co-operation with a closed one-loop system in said control means, providing said model based control design system in said control means including an algorithm with a system identification technique adapted for an external influence from said mathematical model, said operation signal and said position signal, and generating said control signal from said first control means for said piston to be moved in accordance with the instant portion of said design system. Hereby the pneumatic actuator can be controlled in a smooth, even and exact performance according to the position signal and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing the pneumatic components.
Preferably, said piston feature signal comprises a pressure difference signal indicating the actual pressure difference between said first and second chambers, providing said mathematical method estimating at least one parameter in co-operation with a closed two-loop system in said control means; providing a model based control design system in said control means including an algorithm with a system identification technique adapted for an external influence from said mathematical model, said operation signal and said piston feature signal, and generating said control signal from said second
control means for said piston to be moved in accordance with the instant portion of said design system. Hereby the pneumatic actuator can be controlled in a smooth, even and exact performance according to the pressure difference signal and the parameters of the control signal can be adjusted automatically in case of altered parameters during normal operations, or after an installation of a new robot device or changing the pneumatic components.
Suitably, comparing said position signal with said pressure difference signal by said control means, which comprises a comparing algorithm for generating a control signal depending on the actual piston feature. Hereby the pneumatic actuator can be controlled by the external operation signals by either said first piston feature signal or a second piston feature signal or both of said signals depending on which desirable operations the pneumatic actuator has to perform.
Preferably, the control means is provided with determmistically moving designs; said control means comprises a mathematical model for providing a control design system for controlling in a closed loop system a momentary movement of said piston for each moving design based on said at least one piston feature signal; and said control means is adapted to move said piston in accordance with an instant portion of the actual moving design. Hereby said first piston feature signal can be fed to said model based control design system adapted in a one-loop control means.
Suitably, said sensor means comprises a differential pressure transductor adapted to sense the pressure difference between the said first and second chambers and co- operating with said control means for controlling said piston relatively to said cylinder. Hereby both the first piston feature signal and the second piston feature signal can be fed to said model based control design system adapted in a two-loop control means.
Preferably, a valve means is associated with said control means and connectable to said first and second chambers: and said valve means operates to control said piston
relatively to said cylinder. Hereby the piston relatively to the cylinder can be controlled as the valve means controls the pressure into the chambers of the cylinder.
Suitably, a first pressure supply line is connectable between said first chamber and said valve means, and a second pressure supply line is connectable between said second chamber and said valve means. Hereby the pneumatic pressure may have an effect on the piston relatively to the cylinder in at least one direction.
Preferably, at least two pneumatic actuators are provided in an operating system, a co- ordinator means, common for the actuators, is associated with said control means in said control devices in the operating system in order to provide a coordinated operation of them. Hereby a robot arm can be controlled with a good controllability and in an efficient manner.
Suitably, an apparatus for performing an animal related operation having said robot arm, wherein said robot arm is steered by at least two pneumatic actuators each comprising said control device for controlling the motion of said robot arm. Hereby is achieved a controllable motion of said robot arm.
Preferably, said apparatus comprises a co-ordinator means for co-operating with said control device in each of the pneumatic actuators, and said co-ordinator means is adapted to control said control devices in a coordinated operation. Hereby the robot arm can be moved in a co-ordinated smooth, even and exact operation.
Suitably, said robot arm is connected to a robot arm suspension means, which is furthermore hingedly connected to a support means, and said robot arm suspension means being arranged to said support means about an essential horizontal axis, and at least one of said control devices is arranged between said robot arm suspension means and said support means, for allowing said robot suspension means to perform a substantially pendulum movement about said essential horizontal axis (X-X). Hereby is
achieved that the arm has good access to e.g. teats and that the risk is less for dirt, such as manure, to hamper the movement of mechanical parts, as the connection between the robot arm suspension means and the support means is arranged at a level substantially above said animal.
Preferably, at least one of said control devices is arranged between said robot arm and said support means, for actively moving said robot arm in a substantially vertical plane. Hereby is achieved a controllable pendulum movement.
Suitably, said robot arm is pivotally connected to said robot arm suspension means, for allowing said robot arm to perform a pivotal movement in relation to said robot arm suspension means. Hereby is achieved a movability of the robot arm in addition to said pendulum movement.
Preferably, at least one of said pneumatic actuators is arranged between said robot arm and said robot arm suspension means, for actively moving said robot arm in a substantially sideward direction. Hereby is achieved a controllable pivotal movement.
Suitably, said robot arm suspension means comprises a pivot means having a bar movable about a substantially horizontal axis, said bar being provided with a first connection member for said robot arm and a second connection member for said at least one of said pneumatic actuators, each of said first and second connection members being provided with a hinge movable about a substantially vertical axis. Hereby a joint for the pivotal movement is achieved.
DRAWING SUMMARY
The invention will now be described schematically with reference to the accompanying drawings, in which
Figure 1 illustrates a control device according to a first embodiment of the invention,
Figure 2 illustrates a control device according to a second embodiment of the invention,
Figure 3 illustrates a co-ordinator means associated with three control devices for coordinating at least two of said control devices,
Figure 4 illustrates an apparatus for performing an animal related operation arranged with the pneumatic actuators 3a, 3b, 3c.
DETAILED DESCRIPTION OF THE INVENTION
Referring to figure 1 a pneumatic device 2 comprises a pneumatic cylinder 6 provided with a piston 4 connected to a piston rod 8.
A first pressure line 10 is connected to a first chamber 5 a of a cylinder 6 and to a servo valve 20. A second pressure line 12 is connected to a second chamber 5b of the cylinder 6 and to the servo valve 20. The servo valve 20 may be a 5/3 proportional flow control valve, and is controlled by a first control unit 22a controlling the valve 20. The valve 20 operates to control the movement of the piston 4 inside the cylinder 6.
The servo valve 20 is connected to a pressure source 16 by a supply line 14 and is controlled by the unit 22a to feed the pressure of the source 16 to one or the other of the chambers 5a and 5b.
A position sensor 23 is adapted to the cylinder 6 for sensing the position of the piston 4. The position sensor 23 provides a position signal 103 and is connected to the first control unit 22a, which furthermore is connected to the servo valve 20 and to a co- ordinator unit 100. An operation signal 101 is fed to the control unit 22a from the coordinator unit 100. The co-ordinator unit 100 is arranged to co-ordinate for example three pneumatic actuators 3 a, 3 b, 3 c mounted to a robot arm 38 of a milking robot. The robot arm will be further described bellow in connection with fig. 4.
The output of the sensor 23 is fed to the control unit 22a, which for example can be an ordinary kind of computer, with an one-loop implication and which controls the operation of the pneumatic actuator 3. It is possible to have the position sensor 23 to directly indicate the speed of the piston 4, i.e. the position per unit of time. However, it is also possible to have the position as an output and provide the speed indication by for example the sampling rate of an analog-to-digital converter (not shown) converting the analog reading of the sensor 23 into digital values fed to the unit 22a.
The control unit 22a comprises a mathematical model 105 with determined parameters obtained from data collected experimentally. This mathematical model is automatically activated by the algorithm arranged with a system identification technique.
An operation signal 101 is fed to the control unit 22a from a co-ordinator unit 100, which will be described further bellow.
The control unit 22a generates a control signal 102 to the servo valve 20 for controlling the actuator 3. It is to be noted that the pneumatic device shown in fig.1 is intended to be inserted as an element in a steering system, and that the algorithm therefore is dependent on the design of that system and therefore must be determmistically obtained.
The position sensor 23 may be a linear potentiometer inside or outside the cylinder 6 or a linear inductive contactless sensor. Also may at least one optical incremental encoder, rotary potentiometer or rotary incremental or absolute encoder, adapted on a robot arm. be used, which will be further described bellow in connection with fig. 4.
Figure 2 shows an example of a second embodiment of the invention, in which parts denoted with a reference sign correspond to parts of the first embodiment with the same reference sign.
The protection device according to the second embodiment thus includes a differential pressure transductor 30, which is provided in a first connection line 31 between the two chambers 5 a and 5b, and in practice connects the first pressure supply line 10 and the second supply pressure line 12. Furthermore the second embodiment includes a control unit 22b, which is connected to the servo valve 20, to the position sensor 23 and to the differential pressure transductor 30. The transductor 30 is adapted between the first and second chambers 5 a. 5b of the cylinder 6 for sensing the pressure difference between the chambers. The transductor 30 provides a pressure difference signal 104 to the control unit 22 b.
The outputs of the transductor 30 and the sensor 23 are fed to the control unit 22b, which for example can be an ordinary kind of computer, with a two-loop implication and which controls the operation of the pneumatic actuator 3.
The control unit 22b comprises a mathematical model 105' with determined parameters obtained from data collected in an experiment. The mathematical model 105' is more complicated than the model 105 in the first embodiment, since it is dependent by two detected signals, the instant position of the piston and the pressure difference between the chambers 5a and 5b and gives a more defined movement indication for the control of the piston movement.
Said operation signal 101 is fed to the control unit 22b from said co-ordinator unit 100 and a signal is of course fed from the co-ordinator unit 100 to the control unit 22b. The co-ordinator unit 100 operates to steer at least two pneumatic actuators in a coordinated smooth motion. This will further be described in fig.3
Said mathematical model 105' is automatically activated by the algorithm arranged with a system identification technique. The control unit 22b generates a control signal 102 to the servo valve 20 for steering the piston motion in said cylinder 6.
Figure 3 shows an example of an embodiment wherein the co-ordinator unit 100 is connected to a first, a second and a third control device 2a, 2b, 2c.
The co-ordinator unit 100 can for example be an ordinary kind of computer.
The co-ordinator means provides operation signals 101a. 101b, 101c to the control devices 2a, 2b, 2c and operates to co-ordinate the control devices 2a, 2b, 2c for controlling for example a robot arm 38, to make a smooth, exact and even movement along an indicated path. This means that the movement control must be able to provide different speeds for the pistons in the individual pneumatic devices in dependence of the position of the arm along its movement along a path. Therefore, the mathematical models are individual for each pneumatic system.
As shown in figure 4, which illustrates an embodiment of a milking machine in which the control devices described above is included, a robot arm 38 is connected to a robot arm suspension means 40. The robot arm suspension means 40 is hingedly connected to a support means 42 and is arranged to said support means 42 about a horizontal axis
(X-X).
Said robot arm (38) is steered by said actuators (3) comprising said control device (2)
The support means 42 is connected to a railing 50 of an animal stall 60.
The robot arm 38 is pivotally connected to the robot arm suspension means 40.
A first pneumatic actuator 3 a is arranged between the robot arm suspension means 40 and the support means 42.
A second pneumatic actuator 3b is arranged between the robot arm 38 and said support means 42.
A third pneumatic actuator 3 c is arranged between the robot arm 38 and the robot arm suspension means 40.
Furthermore, the robot arm 38 is connected to the suspension means 40 via a pivot means 44, including a tubular member 47. movable about a pair of hinge members 46a, 46b, the tubular member 47 forming a substantially horizontal axis A-A. and furthermore via said third pneumatic actuator 3c connected to the tubular member 47 of the pivot means 44.
The first, second and third pneumatic actuator 3 a, 3b, 3c could be connected to a common control unit (not shown) or separately to its own special control units 22a, 22b (shown in respectively fig.l and 2).
The control units 22a, 22b furthermore can be connected to a co-ordinator unit 100 (not shown), which, for example, may be an ordinary kind of computer.
At least one optical incremental or absolute encoder, rotary potentiometer or rotary incremental encoder, adapted on a robot arm. may be used (not shown) separately or in combination with the position sensor.
OPERATION
The control device according to the invention can be arranged for controlling many different functions. It is an advantage to combine a position sensor means 23 with a differential pressure transductor 30 as the transductor 30 can give the robot arm a sensitivity for detecting obstacle or if, for example, the animal comes in a wrong position.
The force applied to the robot arm is controllable. For example, for teat cleaning, the cleaner can be pushed towards the udder of the animal with a controllable force.
An animal to be milked, such as a cow, has normally different length on the teats. Obviously, the differential pressure transductor 30, as illustrated in figure 2, may be used as an alternative to or in combination with the position sensor 23. For example, when a teat cup (not shown) connected to the robot arm 38 is moved towards a teat of the animal, the teat cup is attached onto the teat in response to said differential pressure transductor 30 for permitting a safe motion towards the teat.
Consequently this function is comfortable for the animal and the teat cup do not press on the udder of a animal if the teat to be milked is shorter than a normal size of the teat.
Furthermore, after the installation of a new robot, or changing pneumatic components the controller shall be adjusted according to the new installed robot system. By means of the automatic parameter tuning of the controller, the parameters for controlling the control device according to the invention, can be adjusted automatically.
This automatic parameter tuning operates to adjust the control signal, even if changes of the position features of the piston arises caused by wear and tear in valves or cylinders, altered data caused by friction, change of temperature e.t.c.
By means of the algorithm implemented in the control means according to the invention, the pneumatic actuators 3 can be controlled in a smooth motion and have a good precision. Thus the algorithm implies that the robot arm can be moved in a smooth motion.
Claims
1. A method for controlling the motion of a pneumatic actuator (3), comprising at least one elongated cylinder (6) provided with a piston (4), dividing the cylinder (6) into a first chamber (5a) and a second chamber (5b), an actuating pressure supply line
(14) connectable to at least one of the first and second chambers (5a, 5b), a control means (22a, 22b) for controlling a motion of the piston (4) relatively to the cylinder (6), and at least one sensor means (23, 30) adapted to sense a piston feature related to the piston motion and co-operating with the control means (22a, 22b), characterized by providing for each elongated cylinder (6), deterministically moving designs i.e. way of movement of the piston (4); providing a mathematical model (105, 105') in said control means (22a, 22b) for providing a control design system which controls in a closed loop system a momentary movement of said piston (4) for each moving design based on at least one signal (103, 104) from the sensor means (23,30) regarding the piston feature; and generating a control signal
(102) from said control means (22a, 22b) to move said piston (4) in accordance with an instant portion of the actual moving design.
2. A method according to claim 1, wherein said design system in said control means (22a, 22b) comprises an algorithm with a system identification technique adapted for an automatic external influence from the mathematical model (105, 105').
3. A method according to claim 1, wherein said piston feature signal fed to the control means (22a), comprises a position signal (103) indicating the actual position of said piston (4); providing said mathematical method (105) estimating at least one parameter in co-operation with a closed one-loop system in said control means (22a); providing said model based control design system in said control means (22a) including an algorithm with a system identification technique adapted for an external influence from said mathematical model (105), said operation signal (101) and said position signal (103); and generating said control signal (102) from said first control means (22a) for said piston (4) to be moved in accordance with the instant portion of said design system.
4. A method according to anyone of the preceding claims, wherein said piston feature signal comprises a pressure difference signal (104) indicating the actual pressure difference between said first and second chambers (5a, 5b); providing said mathematical method (105) estimating at least one parameter in co-operation with a closed two-loop system in said control means; providing a model based control design system in said control means (22b) including an algorithm with a system identification technique adapted for an external influence from said mathematical model (105), said operation signal (101) and said piston feature signal (103, 104); and generating said control signal (102) from said second control means (22b) for said piston (4) to be moved in accordance with the instant portion of said design system.
5. A method according to claim 4, wherein comparing said position signal (103) with said pressure difference signal (104) by said control means (22b), which comprises a comparing algorithm for generating a control signal depending on the actual piston feature.
6. A control device for controlling the motion of a pneumatic actuator (3), comprising at least one elongated cylinder (6) provided with a piston (4), dividing the cylinder (6) into a first chamber (5a) and a second chamber (5b), an actuating pressure supply line (14) connectable to at least one of said first and second chambers (5a, 5b), a control means (22a, 22b) for controlling the motion of the piston (4) relatively to the cylinder (6), and at least one sensor means (23, 30) adapted to sense a piston feature related to the piston motion and co-operating with the control means (22a, 22b), characterized in that said piston (4) is controlled by deterministically moving designs; said control means (22a, 22b) comprises a mathematical model (105, 105') for providing a control design system for controlling in a closed loop system a momentary movement of said piston (4) for each moving design based on said at least one piston feature signal; and said control means (22a, 22b) is adapted to move said piston (4) in accordance with an instant portion of the actual moving design.
7. A device according to claim 6, wherein said sensor means comprises a differential pressure transductor (30) adapted to sense the pressure difference between the said first and second chambers (5a, 5b) and co-operating with said control means (22b) for controlling said piston (4) relatively to said cylinder (6).
8. A device according to claims 6-7, wherein a valve means (20) is associated with said control means (22a, 22b) and connectable to said first and second chambers (5a, 5b); and said valve means (20) operates to control said piston (4) relatively to said cylinder (6).
9. A device according to claims 6-8, wherein a first pressure supply line (10) is connectable between said first chamber (5a) and said valve means (20); and a second pressure supply line (12) is connectable between said second chamber (5b) and said valve means (20).
10. A device according to claims 6-9, wherein at least two pneumatic actuators (3) are provided in an operating system; a co-ordinator means ( 100), common for the actuators, is associated with said control means (22a, 22c) in said control devices (2) in the operating system in order to provide a coordinated operation of them.
1 1. An apparatus for performing an animal related operation having a robot arm (38), wherein said robot arm (38) is steered by at least two pneumatic actuators (3) each comprising said control device (2a, 2b, 2c) according to claim 6 for controlling the motion of said robot arm (38).
12. An apparatus according to claim 1 1, wherein said apparatus comprises a coordinator means (100) for co-operating with said control device (2a, 2b, 2c) in each of the pneumatic actuators; and said co-ordinator means (100) is adapted to control said control devices (2a, 2b, 2c) in a coordinated operation.
13. An apparatus according to claim 1 1, wherein said robot arm (38) is connected to a robot arm suspension means (40), which is furthermore hingedly connected to a support means (42), and said robot arm suspension means (40) being arranged to said support means (42) about an essential horizontal axis (X-X), and at least one of said control devices (2a) is arranged between said robot arm suspension means (40) and said support means (42), for allowing said robot suspension means (40) to perform a substantially pendulum movement about said essential horizontal axis (X- X).
14. An apparatus, according to claim 1 1 or 12, wherein at least one of said control devices (2b) is arranged between said robot arm (38) and said support means (42), for actively moving said robot arm (38) in a substantially vertical plane.
15. An apparatus, according to claims 13 or 14, wherein said robot arm (38) is pivotally connected to said robot arm suspension means (40), for allowing said robot arm (38) to perform a pivotal movement in relation to said robot arm suspension means (40).
16. An apparatus, according to claim 15, wherein at least one of said control devices (2c) is arranged between said robot arm (38) and said robot arm suspension means
(40), for actively moving said robot arm (38) in a substantially sideward direction.
17. An apparatus, according to claim 16, wherein said robot arm suspension means (40) comprises a pivot means (44) having a bar movable about a substantially horizontal axis (A-A), said bar being provided with a first connection member (45) for said robot arm (38) and a second connection member (46) for said at least one of said control devices (2c), each of said first and second connection members (45, 46) being provided with a hinge movable about a substantially vertical axis.
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
SE9802997A SE522303C2 (en) | 1998-09-04 | 1998-09-04 | Apparatus and method for controlling the movement of a pneumatic actuator |
SE9802997 | 1998-09-04 | ||
PCT/SE1999/001526 WO2000013858A1 (en) | 1998-09-04 | 1999-09-03 | A device and a method for controlling the motion of a pneumatic actuator |
Publications (1)
Publication Number | Publication Date |
---|---|
EP1124668A1 true EP1124668A1 (en) | 2001-08-22 |
Family
ID=20412488
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
EP99946554A Withdrawn EP1124668A1 (en) | 1998-09-04 | 1999-09-03 | A device and a method for controlling the motion of a pneumatic actuator |
Country Status (4)
Country | Link |
---|---|
EP (1) | EP1124668A1 (en) |
AU (1) | AU5894799A (en) |
SE (1) | SE522303C2 (en) |
WO (1) | WO2000013858A1 (en) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014066627A1 (en) * | 2012-10-24 | 2014-05-01 | California Institute Of Technology | Hydraulic high pressure valve controller using the in-situ pressure difference |
CN115844054A (en) * | 2022-12-02 | 2023-03-28 | 江西中烟工业有限责任公司 | Protection support device |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2600120B1 (en) * | 1986-06-12 | 1990-06-29 | Bertin & Cie | METHOD AND DEVICE FOR CONTROLLING THE POSITION OF A PNEUMATIC CYLINDER |
GB8900084D0 (en) * | 1989-01-04 | 1989-03-01 | British Res Agricult Eng | Milking |
US5424941A (en) * | 1991-08-02 | 1995-06-13 | Mosier Industries, Inc. | Apparatus and method for positioning a pneumatic actuator |
MX9306169A (en) * | 1992-10-05 | 1995-01-31 | Fisher Controls Int | CALIBRATION OF THE ELECTRO-PNEUMATIC CONVERTER. |
GB9306896D0 (en) * | 1993-04-01 | 1993-05-26 | Emhart Int Ltd | Control system suitable for glassware forming machine |
-
1998
- 1998-09-04 SE SE9802997A patent/SE522303C2/en not_active IP Right Cessation
-
1999
- 1999-09-03 WO PCT/SE1999/001526 patent/WO2000013858A1/en not_active Application Discontinuation
- 1999-09-03 AU AU58947/99A patent/AU5894799A/en not_active Abandoned
- 1999-09-03 EP EP99946554A patent/EP1124668A1/en not_active Withdrawn
Non-Patent Citations (1)
Title |
---|
See references of WO0013858A1 * |
Also Published As
Publication number | Publication date |
---|---|
SE9802997D0 (en) | 1998-09-04 |
SE522303C2 (en) | 2004-01-27 |
AU5894799A (en) | 2000-03-27 |
SE9802997L (en) | 2000-03-05 |
WO2000013858A1 (en) | 2000-03-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1657612B1 (en) | Moving distance sensing apparatus for robot cleaner and method therefor | |
US5520262A (en) | Electrohydraulic steering system | |
EP0414279A2 (en) | Tractor hitch control system | |
US5908081A (en) | Steering control system for articulated vehicle | |
CN107406237A (en) | The position control of arm support tail end | |
EP0816573A3 (en) | Front control system for construction machine | |
KR20010023263A (en) | System and method for controlling a robot | |
US20100139424A1 (en) | Vibrator for a ground compacting apparatus | |
US6476574B1 (en) | Method and device for controlling the movement of a movable part | |
EP1124668A1 (en) | A device and a method for controlling the motion of a pneumatic actuator | |
US6405632B1 (en) | Protection device for controlling the motion of a pneumatic actuator | |
US5899279A (en) | Tractor electronic linkage control system | |
EP0390288A1 (en) | Trailer steering device | |
JP4215920B2 (en) | Method and apparatus for applying at least one milk tank to an animal's breast | |
US4455035A (en) | Anti-jackknifing device with friction brake for articulated motor vehicle | |
AU763934B2 (en) | Apparatus and method for controlling the position of an arm on a hitch | |
EP0113121B1 (en) | Pressure-compensated hydraulic positioning system | |
US6250396B1 (en) | Method and apparatus for controlling a hitch | |
GB2095644A (en) | A pantograph linkage | |
JP6632507B2 (en) | Link mechanism control device, manipulator, and link mechanism control method | |
JPH088803B2 (en) | Tilt control device for agricultural work machines | |
SU1068253A1 (en) | Milling machine support | |
JP2559714B2 (en) | Tractor | |
SU1387888A1 (en) | System for automatic driving of farm machines along harrow | |
SU800292A1 (en) | Device for controlling load-handling machine boom |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PUAI | Public reference made under article 153(3) epc to a published international application that has entered the european phase |
Free format text: ORIGINAL CODE: 0009012 |
|
17P | Request for examination filed |
Effective date: 20010216 |
|
AK | Designated contracting states |
Kind code of ref document: A1 Designated state(s): AT BE CH CY DE DK ES FI FR GB GR IE IT LI LU MC NL PT |
|
STAA | Information on the status of an ep patent application or granted ep patent |
Free format text: STATUS: THE APPLICATION IS DEEMED TO BE WITHDRAWN |
|
18D | Application deemed to be withdrawn |
Effective date: 20060906 |