The present invention relates to a method for controlling a gripper for grasping an object, particularly for robotic applications.
Automatic grippers suitable to grasp and carry an object are well known. Generally, grippers comprise a gripper body and at least two gripper fingers, also called “jaws” in technical jargon, which are movable with respect to the gripper body between an idle open position and a closed position for grasping an object.
One of the problems that automatic grippers suffer from is detecting the slippage of the grasped object between the jaws in a timely manner, so as to prevent it from being lost during transport or otherwise released not in the exact position where it was intended.
For this purpose, grippers equipped with sensors have been proposed.
The idea of adding slip measurement to artificial hands was first considered during the latter half of the 1960s. In L. L. Salisbury and A. B. Colman, A mechanical hand with automatic proportional control of prehension. Medical and biological engineering, 1967, the integration of a piezoelectric crystal in the thumb of a mechanical hand is described. Baits et al. replicated this device immediately after on a two-dimensional gripper (J. Baits et al., The Feasibility of an Adaptive Control Scheme for Artificial Prehension. Proceedings of the Institution of Mechanical Engineers, 1968).
The purpose was, in both cases, to detect vibrations due to slippage and to input a corresponding signal into the manipulator control loop. However, no experimental studies were performed to demonstrate the ability of such systems thus fitted with sensors to detect slippage.
Many other approaches were proposed in the following decades, as reported in M. Francomano et al., Artificial sense of slip—A review. IEEE Sensors, 2013. These include one approach that makes use of the center of pressure (CoP). The center of pressure may be reconstructed from an array of piezoresistive pressure sensors (E. Holweg et al., Slip detection by tactile sensors: algorithms and experimental results. ICRA 1996) or of capacitive sensors (X. Zhang and R. Liu, Slip detection by array-type pressure sensor for a grasp task. ICMA 2012), and then analyzed in the frequency domain through techniques such as Fast Fourier Transform (FFT) or Power Spectrum to assess the occurrence of a slip. Alternatively, the CoP may be measured by a specific sensor that also provides the total load applied thereon (D. Gungji et al., Grasping force control of multi-fingered robot hand based on slip detection using tactile sensor. Journal of the Robotics Society of Japan, 2007). The voltage output of the sensor was fed into the control circuit of a gripper: if a significant drop in this voltage was detected, the clamp increased the force applied. This approach has been integrated with a proximity sensor that measures the position of the object to be grasped by the gripper (H. Hasegawa et al., Development of Intelligent Robot Hand using Proximity, Contact and Slip sensing. ICRA 2010).
Slip may also be inferred using optical sensors. For example, said sensors were integrated into the fingertips of a robotic hand (DLR/HIT) connected to the right arm of a mobile robotic platform (TUM-Rosie) (A. Maldonado et al., Improving robot manipulation through fingertip perception. IROS 2012). The sensor consisted of a miniature camera and a laser emitter. The fingertip thus equipped allowed the recognition of slip events when the surface of the grasped object moved with respect to the sensor target.
In U.S. Pat. No. 8,515,579B2, a gripper is provided with instrumentation to manipulate grasped objects. The gripper has sensors to determine a vector field based on spatially distributed data in time, measured at different positions on the grasped object. However, the position of objects is not evaluated prior to the grasping action.
Thus, the problem of correct and timely detection of the slippage of an object grasped by a clamp has not been completely solved.
Therefore, the object of the present invention is to propose a method for controlling a gripper, particularly a gripper for robotic applications, that is able to solve this problem.
Said object is achieved by a method for controlling the grasping of an object by means of a gripper according to claim 1 and by means of a gripper according to claim 9.
The dependent claims describe preferred or advantageous embodiments of the control method and of the gripper.
According to a general embodiment, the control method comprises the steps of:
In one embodiment, after step e), the method is repeated from step d).
In one embodiment, the reference position is detected by means of at least one position sensor and/or at least one center of pressure sensor.
According to an embodiment, the reference position is computed as an average of a set of measurements obtained, in a predetermined time interval, from the at least one position sensor and/or the at least one center of pressure sensor.
In some embodiments, a displacement of the grasped object with respect to the reference position is detected if the difference between a position datum obtained from the at least one position sensor and the reference position is greater than a predetermined threshold value and/or if the difference between a position datum obtained from the at least one center of pressure sensor and the reference position is greater than a predetermined threshold value.
According to a general aspect of the invention, a gripper is proposed, comprising:
In one embodiment, the processing unit is programmed to repeat the control method from step d) after performing step e).
In one embodiment, the processing unit is programmed to compute the reference position as an average of a set of measurements obtained, over a predetermined time interval, from the at least one position sensor and/or the at least one center of pressure sensor.
Further features and advantages of the control method and of the gripper according to the invention shall be made readily apparent from the following description of preferred embodiments thereof, provided purely by way of non-limiting example, with reference to the accompanying figures, wherein:
In said drawings, a gripper for grasping an object according to the invention has been indicated schematically as a whole with the reference number 1.
The gripper 1 comprises a gripper body 10 and at least two gripper jaws 12 which are movable with respect to the gripper body 10 between an idle open position and a closed object-grasping position.
The jaws 12 may be moved by electric, hydraulic, pneumatic actuators, or combinations thereof.
The gripper 1 is provided with at least one proximity sensor 14 suitable to detect the presence of the object to be grasped within the field of view 14′ of the proximity sensor 14.
For example, the proximity sensor 14 is positioned to direct the field of view 14′, e.g., conical in shape, between the two jaws 12.
In the embodiment of
The gripper 1 is further provided with a grasping force sensor 16 (“FS”), suitable to measure the grasping force exerted by the jaws 12 on the object, and at least one center of pressure sensor 18 (“CoPS”), suitable to detect the coordinates of the center of pressure (“CoP”) between the jaws 12 of the gripper when the jaws exert a grasping force on the object.
In one embodiment, the force sensor 16 and the center of pressure sensor 18 coincide.
The gripper 1 is controlled by a processing unit 20 operationally connected to the proximity sensor 14, the grasping force sensor 16, the center of pressure sensor 18, and the jaw actuator means 12, and programmed to carry out a method for controlling the gripper based on information received from the sensors.
The processing unit 20 may be located within the gripper body 10, but may also be located externally to the gripper 1.
The control method described below enables the gripper 1 to stably grasp an object and to avoid slippage phenomena when the gripper holds said object between its jaws.
The following definitions will be used in the remainder of this description:
As mentioned above, in one embodiment the at least one center of pressure sensor 18 coincides with the grasping force sensor 16. In this case, the effective grasping force (Fm) sensor is also able to measure torque. In fact, considering the X, Y, and Z axes as depicted in the figures, the processing unit 20 is programmed to compute the CoPX and CoPY coordinates of the center of pressure as:
where MX and MY are the measured moments of the effective grasping force sensor (Fm) along the X and Y axes, respectively, as shown in the figures, and where |FZ| is the modulus of the effective grasping force (Fm) along the Z axis.
In one embodiment, the proximity sensor 14 is an ultrasonic or infrared sensor.
In one embodiment, the force sensor 16 and/or the center of pressure sensor 18 are made with a sensor unit array, such as of a capacitive type, so as to make a tactile skin, and/or with a force/torque sensor.
Referring to the flowchart in
The gripper, by means of the proximity sensor(s) 14, monitors a grasping area to detect the presence of the object to be grasped (step 100).
Once an object has been detected, a comparison is made between the position of the object to be grasped (Pos) and a predetermined grasping position (Pos1) (step 102). The predetermined grasping position may be defined as the position the object must assume in order to be grasped correctly.
When the distance between the object position (Pos) and the grasping position (Pos1) is less than a predetermined threshold value (ThPos1), the gripper is commanded to grasp the object with a predetermined grasping force F1 (step 104).
The effective grasping force (Fm) is then measured (step 106). The grasping force sensor 16 may be used to measure the actual grasping force (Fm).
A comparison is then made between the predetermined grasping force (F1) and the effective grasping force (Fm) (step 107).
When the difference between the predetermined grasping force (F1) and the effective grasping force (Fm) is less than a predetermined threshold value (ThF), a reference position of the grasped object (or “zero” position) with respect to a reference system integral to the gripper is computed (step 108).
The position of the grasped object is then monitored as the object is transported from the pickup point to a release point (step 110).
If a displacement of the object from the reference position (step 112) is detected, the gripper is commanded to increase the grasping force (step 114), for example to a second predetermined grasping force value (F2).
In some applications, monitoring the grasping area and comparing the position of the object to be grasped (Pos) to a predetermined grasping position (Pos1) may not even be required. In these cases, the control method provides, as the first step, for directly grasping the object with a predetermined grasping force F1 (step 104).
In one embodiment, after increasing the grasping force, the reference position of the object is again monitored. If another displacement is detected, the grasping force is increased further. This closed-loop control may then be repeated several times until the gripper has reached the release position of the object.
In some embodiments, the increase in grasping force is performed continuously, such as through a PID-type control. In these embodiments, for example, the gripper comprises proportional control means controllable by the processing unit to continuously control the grasping force.
In one embodiment, the reference position is detected by the one or more position sensors, such as said proximity sensors 14, and/or the center of pressure sensor(s) 18.
In one embodiment, the reference position is computed as an average of a set of measurements obtained, in a predetermined time interval of, for example, one or two seconds, from the at least one position sensor and/or the at least one center of pressure sensor.
For example, a displacement of the object with respect to the reference position is detected if the difference between a position datum obtained from the at least one position sensor and the reference position is greater than a predetermined threshold value, and/or if the difference between a position datum obtained from the at least one center of pressure sensor and the reference position is greater than a predetermined threshold value.
In one embodiment, the control method described above is implemented with a finite state machine, the state diagram of which is depicted in
The five states are as follows:
In one embodiment illustrated in the diagram in
In the embodiment of
Therefore, the grasp control algorithm allows for:
The algorithm therefore controls the gripper from the step of checking for the presence of an object between its jaws, and thus even before starting the actual grasping operation, until the completion of said grasping operation.
In the IDLE state, the gripper does nothing and “waits” to begin a grasping operation. When the position of the object is considered correct, i.e., the proximity sensor output is in the allowable range, the gripper is commanded to grasp the object.
Before moving to the next state, the stability of the grasp is checked. The stability is ensured by controlling the measured force, which must be close to the desired force (F1).
When this happens, with the object stably grasped between the gripper jaws, a reference position is computed. For this purpose, the position of the object is observed for a predetermined time interval, such as a couple of seconds. The reference position or “zero” may be computed as the average of the corresponding number of measurements taken. The reference position is then used in the “hold” state, and possibly in the “tighten” state.
In fact, in the “hold” state, any motion of the object with respect to the zero reference position thus computed will be compensated by increasing the grasping force to a second level F2. For this purpose, a closed-loop force control algorithm may be employed.
The OBJECT MOTION DETECTED transition may occur multiple times and may be compensated for by iterating the “TIGHTEN” state, even with multiple force levels greater with respect to the second force level F2.
In one embodiment, the “zero” position is computed as follows:
where CoPk is a vector containing the two components of CoP at the instant k, while n is the total number of CoPk values accumulated in a fixed time interval, also user-definable. Regardless of the length of the observation window, consisting of k norm values of the CoP, the grasping device will have to wait for these values to be collected in order to compute the zero position. The zero position, therefore, is updated with each new grasping operation.
Once the zero position is available, the algorithm provides for the grasping of the workpiece (HOLD). Only at this point will the processing unit of the grasping device evaluate, at each instant, the possible slippage of the workpiece.
In one embodiment, the norm D of the difference vector between the CoP and the zero position is evaluated against the predefined threshold. In formulas, this will be:
D=∥zero−CoPi∥, where
CoPi is defined as the value of the CoP at the i-th instant, after computing the zero position. If and only if D exceeds a predefined threshold will the OBJECT MOTION DETECTED transition take place as a result of the detected slippage of the grasped workpiece.
The proposed control method achieves the intended purpose.
The grasping systems of the state of the art do not check whether the grasped object is grasped stably. The object is picked up and held without knowing whether the applied force matches the desired force (see, e.g., Costanzo et al., 2020). The control method according to the present invention solves this problem by instead checking whether the effective grasping force is close to a predetermined grasping force (STABLE GRASP transition: |F1−Fm|<ThF).
The grasping systems of the state of the art do not compute a reference position of the grasped object (as, for example, in Hasegawa et al., 2010). This may cause uncertainty in grasping. The present invention solves this problem by computing a reference position of the object when it is stably grasped. Once computed, this position does not change during the operation of the gripper.
In the grasping systems of the state of the art, when the center of pressure is used to detect slippage phenomena, it is measured by an additional sensor with a voltage output (see, for example, Hasegawa et al., 2010). In a preferred embodiment, the present invention solves this problem because both grasping force and center of pressure (CoP) are measured by the same sensor.
The control method according to the invention makes it possible to recognize when the object is in the correct position to be grasped.
By detecting the center of pressure, it is possible to know where the applied pressure is concentrated.
According to the proposed control method, a reference position of the grasped object is computed, with respect to which any displacement is then detected, only when the object is stably grasped.
The method according to the invention recognizes when the object moves from the reference position and applies a force correction accordingly.
A person skilled in the art may make several changes, adjustments, adaptations, and replacements of elements with other functionally equivalent ones to the embodiments of the method for controlling the grasping of an object and of the gripper according to the invention in order to meet incidental needs, without departing from the scope of the following claims. Each of the features described as belonging to a possible embodiment may be obtained independently of the other described embodiments.
Number | Date | Country | Kind |
---|---|---|---|
102021000008006 | Mar 2021 | IT | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/IB2022/052941 | 3/30/2022 | WO |