Parallel mechanism with actuator mechanism for remotely operated gripper
The parallel mechanism with direct-drive actuators and four-bar linkages in the 4+1 DOF parallel robot addresses the limitations of serial kinematic cobots by reducing inertia and enhancing interaction bandwidth, resulting in high-speed and precise physical human-robot interaction with unlimited gripper rotation.
Patent Information
- Application Number
- PCT/CA2024/050660
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Priority Date
- 2023-05-18
- Filing Date
- 2024-05-17
- Publication Date
- 2024-11-21
AI Technical Summary
Existing collaborative robots (cobots) based on serial kinematic architectures have limited interaction bandwidth and high inertia due to mass and high reduction ratios, making physical human-robot interaction less efficient.
A parallel mechanism with a direct-drive actuator mechanism that reduces inertia and allows for low-impedance mechanical backdrivability, enabling a gripper with unlimited rotation and improved interaction bandwidth through a kinematically redundant 4+1 DOF parallel robot with four-bar linkages and a pin-in-slot mechanism.
The solution achieves high-speed and high-precision performance with reduced inertia and improved physical interaction bandwidth, making the robot safer and more effective for physical human-robot interaction while maintaining unlimited rotation of the gripper.
Smart Images

Figure CA2024050660_21112024_PF_FP_ABST
Abstract
Description
PARALLEL MECHANISM WITH ACTUATOR MECHANISM FOR REMOTELY OPERATED GRIPPER CROSS-REFERENCE TO RELATED APPLICATION
[0001] The present application claims the priority of United States Patent Application No.63 / 503,036, filed on May 18, 2023, the entire contents of which are incorporated herein by reference. TECHNICAL FIELD
[0002] The application relates to robots such as collaborative robots (a.k.a., cobots), and to actuation thereof. BACKGROUND
[0003] Colaboratives robots, i.e., cobots, appeared in the robotics landscape decades ago and have since then become ubiquitous in the automation industry. Their simplicity of use and implementation contributed to the democratization of robots in a wide range of automation ¿elds. This ease of use mainly comes from the backdrivabilty of collaborative robots, namely the ability for interactive transmission of force to the robot. Hence, as an example, the user may intuitively teach waypoints to the robot without requiring complex programming knowledge. Physical Human-Robot Interaction (pHRI) has been the centre of interest of many research initiatives, since it is the main distinctive aspect of cobots compared to traditional industrial robots.
[0004] Many existing cobots are based on a serial kinematic architecture using gear reduction at the joints and made backdrivable through the use of a force / torque sensor mounted at the end-effector. This makes the quality of the physical interaction with the human user highly dependent on the sensing capabilities and control schemes. Moreover, due to the mass of their moving parts and the high reduction ratio of their joint transmissions, the physical interaction has a low bandwidth and such robots may appear as high inertia devices to the human user.
[0005] A solution proposed to improve the interaction bandwidth and reduce the interaction forces is the use of parallel robots as cobots. Parallel architectures may achieve higher speed performances whilst still maintaining a high level of precision.Additionally, since the actuators of parallel robots can be ¿xed to the base or mounted on links that are close to the base, the reduction ratios of the mechanical drives can be reduced or made equal to unity (direct-drive), thereby drastically reducing the inertia reÀected at the end effector. SUMMARY
[0006] In one aspect, there is provided a robot comprising: a gripper having at least a pair of fingers movable relative to one another in a grasping action; a parallel mechanism having an end effector operatively supporting the gripper, the parallel mechanism being operable to selectively displace the gripper in three translational degrees of freedom (DOF), the parallel mechanism having a leg for imparting rotational movement to the end effector; and an actuator mechanism to actuate the gripper in the grasping action, the actuator mechanism including a member displaceable in translation relative to the end effector, the member operatively connected to the gripper such that the translation causes the grasping action, a link pivotally connected at a first end thereof to the leg by a first joint having at least one rotational degree of freedom, the link pivotally connected at a second end thereof to the member by a second joint having at least one rotational degree of freedom, whereby a rotational actuation of the leg is convertable to said translation via the link.
[0007] Further in accordance with the aspect, for example, a pin-in-slot mechanism may be between the member and the fingers.
[0008] Still further in accordance with the aspect, for example, the fingers are connected to the end effector by four-bar linkages.
[0009] Still further in accordance with the aspect, for example, the four-bar linkages are parallelogram four-bar mechanisms.
[0010] Still further in accordance with the aspect, for example, a link of each of the four-bar linkage is operatively connected to the member for causing the grasping action from the translation of the member.
[0011] Still further in accordance with the aspect, for example, the link of each of the four-bar linkage is connected to the member by a pin-in-slot mechanism
[0012] Still further in accordance with the aspect, for example, a pin may be at the end of the link of each of the four-bar linkage for forming the pin-in-slot mechanism.
[0013] Still further in accordance with the aspect, for example, the fingers move in a constant orientation relative to the end effector.
[0014] Still further in accordance with the aspect, for example, the fingers each have a distal inward surface.
[0015] Still further in accordance with the aspect, for example, the robot has two of the fingers, and wherein the distal inward surfaces of the fingers are parallel to one another.
[0016] Still further in accordance with the aspect, for example, the member defines a suction passage therethough, and further including a suction cup at the distal end of the member, between the pair of fingers, the suction cup being in fluid communication with the suction passage.
[0017] Still further in accordance with the aspect, for example, the member is tubular, the suction passage being defined by an inner cavity of the member.
[0018] Still further in accordance with the aspect, for example, the end effector is unconstrained in one rotational degree of freedom, such that the leg imparts unlimited revolutions to the end effector.
[0019] Still further in accordance with the aspect, for example, the first joint is a revolute joint.
[0020] Still further in accordance with the aspect, for example, the second joint is a revolute joint.
[0021] Still further in accordance with the aspect, for example, the parallel mechanism constrains the end effector to movement in three translational degrees of freedom and one rotational degree of freedom.
[0022] Still further in accordance with the aspect, for example, the robot has five actuators, such as in a 4+1 configuration.
[0023] Still further in accordance with the aspect, for example, one of the five actuators is for the leg and is on a base.
[0024] Still further in accordance with the aspect, for example, all of the five actuators, except for the one actuator for the leg, are rotational actuators having rotational axes parallel to one another.
[0025] Still further in accordance with the aspect, for example, the rotational axes are colinear. DESCRIPTION OF THE DRAWINGS
[0026] Reference is now made to the accompanying figures in which:
[0027] Fig. 1 is a schematic view of kinematically redundant 4+1 DOF parallel mechanism having an actuator mechanism in accordance with a variant of the present disclosure;
[0028] Fig.2 is a representation of vectors gi, ui, i=1, 2 and d;
[0029] Fig.3 is a cross section of a gripper actuated by the actuator mechanism of the present disclosure, closed (left) and open (right);
[0030] Fig. 4 an elevation view of the actuator mechanism of the present disclosure, corresponding to the gripper being closed (left), and the gripper being open (right);
[0031] Fig.5 is a geometric representation of the gripper, closed (left) and open (right);
[0032] Fig.6 is a geometric representation of the redundant link, gripper closed (left) and gripper open (right);
[0033] Fig.7 is a perspective view of a parallel robot as in Fig.1, with the actuator mechanism of the present disclosure;
[0034] Fig.8 is a schematic view of an unlimited rotation workspace (blue volume) superimposed on the parallel robot with the actuator mechanism of Fig.7;
[0035] Fig. 9 is an exemplary graph of experimental results for a high-speed trajectory: actuated joint position, joint position error and joint torque;
[0036] Fig. 10 is an exemplary graph of experimental results for a high-speed trajectory: position and velocity along the x axis;
[0037] Fig.11 is an exemplary set-up with the force sensor on the end-effector;
[0038] Fig.12 is an exemplary graph of velocity and force for a 2Hz oscillatory motion imparted on the end-effector along the x and z axes; and
[0039] Fig.13 is an exemplary graph of velocity and force for a 1 Hz oscillatory motion imparted on the end-effector in the x and z axes. DETAILED DESCRIPTION
[0040] The present disclosure pertains to a parallel mechanism, also referred to as a parallel robot, that may be said to be a low-impedance mechanically backdrivable robot for intuitive pHRI, for example. To do so, in a variant, direct-drive actuators are used, thereby eliminating the ampli¿cation of rotor inertia. Given the architecture of a parallel robot described herein, the mass and inertia of the moving parts may also be reduced. As these principles are combined, low-impedance mechanical backdrivability is obtained, such that the human user may feel but a fraction of the inertia of standard cobots.
[0041] Futhermore, the parallel robot of the present disclosure may integrate an actuator mechanism in its architecture, such that a redundant DOF can be used to operate a gripper at the end effector, as an option. Accordingly, it is possible to operate the gripper from actuators on the base, in a possible configuration. This removes the need for a sixth actuator at the end effector to operate the gripper, thereby further reducing the moving mass and inertia at the end effector. The need for a motor at the end effector would otherwise entail the use of an electrical cable or like wire or pipe, that would prevent unlimited rotation. Thus, the actuator mechanism of the present disclosure allows a remotely operated gripper to maintain an unlimited rotation feature of the parallel robot while reducing the mass and inertia needed to operate such a gripper.
[0042] Referring to Fig.1, there is illustrated a kinematically redundant parallel robot 10 that may use the actuator mechanism of the present disclosure, as detailed below. The parallel robot 10 may be referred to as a Selective Compliance Assembly Robot Arm (SCARA), taking into account a contemplated use. The parallel robot 10 may have a base 11 (a.k.a., frame, ground) and an end effector 12 (a.k.a., moving platform 12), the base 11 being provided to support legs that actuate the motion of the end effector 12. The base 11 may or may not be part of the parallel robot 10. For example, the parallel robot 10 may be mounted to an existing structure, to the ground, etc, in which case the base 11 is not an integral part of the parallel robot 10. For reference, the expressions “proximal” and “distal” are used herein, according to the convention by which proximal is on the side of the base 11 and distal is on the side of the end effector 12.
[0043] The end effector 12 is shown without any component thereon, but may support a gripper as detailed hereinafter. Alternatively, the end effector 12 may receive thereon equipment, systems, tools, seats, etc, all of which depend on the use of the parallel robot 10.
[0044] The parallel robot 10 has legs that may be composed of various joints interconnecting links (a.k.a., bars, linkages, members), such as: x Revolute joints (R): joints providing one rotational degree of freedom (rDOF), which may be referred to as pivots, hinges, etc.; x Prismatic joints or sliding joints (P): joints providing one translational degree of freedom (tDOF); x Cylindrical joints (C): joints providing one tDOF and one rDOF; x Universal joints (U): joints providing two rDOFs, with rotational axes of the two rDOFs intersecting each other at an intersection (e.g., a center); x Spherical joints (S): joints providing three rDOFs, with rotational axes of the rDOFs intersecting each other at a center. The intersection of rotational axes in universal joints and / or spherical joints is in contrast with pairs of sequential rotational joints that do not have intersecting axes.
[0045] Referring to Fig.1, the axis of rotation of the end effector 12 is constrained by two parallelogram linkages 13A contained in legs 13. The end effector 12 may be constrainted to moving in three translations DOFs, and may rotate about itslongitudinal axis in an embodiment. These two legs 13 also control two translational DOFs of the end effector 12. The two legs 13 may each include an actuator 13B mounted to the base 11, with a rigid link li1(i=1,2) extending from the actuator 13B to the parallelogram linkages 13A. The rigid link li1 is the proximal coupler of the two parallelogram linkages 13A with links of length li2connecting point Sito point Bi(for i = 1, 2). In the two parallelogram linkages 13A, four spherical joints (or universal joints) connect the two rigid links li2with the rigid link li1and a proximal coupler, the former being, in fact, the end effector 12, such as in a RR3R, in which 3 is a parallelogram.
[0046] The third translational DOF and the orientation DOF of the end effector 12 are controlled by the position of a rigid link 14, connected for instance to the proximal end of the end effector 12 with a revolute joint 14A. The link 14 is part of a leg 15, and its position is controlled by the interaction between leg 15 and two other legs, namely legs 16. Leg 15 may have a RSSR configuration (or alternatively, RUUR, RUSR, RSUR), with the R joint being on the base 11 with its actuator 15B. The distalmost S joint or U joint may interconnect the link 14 to link 15A. Legs 16 are connected to the link 15A, and may also have a RSS configuration (or alternatively, RUU, RUS, RSU), with the R joint being on the base 11 with the actuator 16B. Other options are possible.
[0047] The architecture is such that the legs 16 can impart a rotation to the link 14 of the leg 15 by their actuation, the rotation being with respect to axis Y in Fig.1. As the end effector 12 is connected to the link 14 and supported by legs 13 by rotational joints having two or more rotational DOFs, the end effector 12 may rotate about its longitudinal axis, parallel to axis Y in Fig.1.
[0048] In a variant, the rotational axes of the actuators 13B and 16B are all parallel to one another, and may lie in a common plane. The rotational axes of the actuators 13B and 16B may optionally all be collinear, as in Fig.7. A rotational axis of the actuator 15B may be transverse to the rotational axes of the actuators 13B and 16B. Since there is the revolute joint 14A between the rigid link 14 and the end effector 12, their relative orientation can be adjusted and the parallel robot 10 has therefore one redundant DOF in addition to the four basic DOFs corresponding to the SCARA motion. Other variants are possible, the parallel robot 10 being an example of a robot 10 that may use an actuator mechanism in accordance with the present disclosure, as described as actuator mechanism 30 below.
[0049] The geometric model of the parallel robot 10 is shown with reference to Fig. 1, and may be referred to as a Selective Compliance Assembly Robot Arm (SCARA), taking into account a contemplated use. The kinematic modelling focuses on the architecture that moves the tool centre point (TCP) along the xyz axes and rotates around the y axis. In Fig.1, the parallel robot 10 may have five actuated revolute joints mounted to the base 11, and located at points Ai, i= 1,...,5. The orientation of the links attached to these revolute joints, relative to the ¿xed x axis (¿xed z axis in the case of A5), are the joint coordinates Ⴉi.
[0050] The distance between points Biand Siis expressed in order to obtain the constraint equations More details leading to (1) are known in the art.
[0051] The Jacobian matrices providing the relationship between the actuator joint velocities (de¿ned by vector ^^, containing all ¿ve actuated joint velocities) and the Cartesian velocities ( ^)^ of the end effector are defined as with
[0052] It is noted that the vector of Cartesian velocities is augmented with ^^ , which is the velocity associated with the redundant DOF.
[0053] The Jacobian matrices can be expressed asa w where vi is the distance between point Bi and point B5. Vectors d, gi, ui,i =1, 2 are represented in Fig.2 and matrices E and E5are de¿ned aswhere Ri(Ⴉ) represents a rotation of angle Ⴉ around axis i.
[0054] The parallel robot 10 has few degenerate cases of singularities. The most notable of these cases corresponds to Ȗ =0 or 180ƕbut this case cannot occur because of the implementation of the gripper as described below. Indeed, the actuator mechanism that drives the gripper is designed to mechanically constrain angle Ȗ of the redundant link within a certain range of angular movement to avoid this singularity. Singularities are nevertheless taken into account in the robot’s controller to preventany degeneracy. The remaining singular con¿gurations are located at the boundaries of the workspace of the parallel robot 10.
[0055] The solution of the inverse kinematic problem consists in determining the input joint angles ^i,i =1,...,5 for given values of the Cartesian coordinates p =[x, y, z]T, angle ij (de¿ned relative to the ¿xed x axis) and of the redundancy parameter Ȗ. Based on the constraint of eq. (1), one readily obtains with andwhere aixstands for the x component of vector ai, which is the position vector of point Ai, similarly for point Biand for the y and z components. Furthermore,
[0056] Using the tangent half-angle substitution and solving the resulting quadratic equation, one obtainsand finally
[0057] Equation (19) is used in the robot’s controller to prescribe a Cartesian position to the TCP and orientation of the end effector and to compute the corresponding joint coordinates.
[0058] The direct kinematic problem aims at determining the Cartesian coordinates (x, y, z, ij, Ȗ) from known actuated joint coordinates (^i, i =1,...,5). The key to the direct kinematics of the parallel robot 10 is obtained by ¿nding the intersections of spheres of radius li2.
[0059] The solution of the direct kinematic problem is used in the robot’s controller when it is in collaborative mode. Indeed, knowing the robot’s Cartesian pose while it is being manipulated by hand allows the controller to adjust the gravitational compensation accordingly. Also, because the taught waypoints can be described in the Cartesian space, linear motion can be easily computed between them. Finally, virtual walls can be implemented using the direct kinematic equations.
[0060] Exploiting the redundancy of a parallel robot 10 to operate a gripper has several bene¿ts. Angle Ȗ of the redundant link can be used to operate such a gripper. In this case, operating the gripper from the base actuators allows the unlimited rotation of the end effector to be preserved while keeping the mass and inertia of the parallel robot 10 low.
[0061] Referring to Fig.3, an embodiment of the gripper 20 is illustrated and has two ¿ngers 21 that are maintained parallel to each other through the use of four-bar linkages 22 (e.g., optionally a parallelogram as shown), by which they are pivotally connected to the end effector 12, shown as being tubular, and referred to as wrist 24. In a variant, the combination of the fingers 21 and the linkages 22 that connect the fingers 21 to the wrist 24 may be referred to as a finger assembly. In another nomemclature, any one of the fingers may be defined as including 21 and one of the linkages 22, in which case 21 is a distal phalange. For simplicity, reference is made herein the finger 21 and linkage 22. The fingers 21 could be connected to the wrist 24 in other ways, including with a single pivot joint. The actuation of the ¿ngers 21 is achieved by the linear motion of a slider 23 (also referred to as translating component 23) that moves through the robot’s wrist 24, defined by the tubular body of the end effector 12. The slider 23 may or may not be a part of the gripper 20. As describedabove, the slider 23 is linked to the ¿ngers 21 with a pin-in-slot mechanism 25, as one possible mechanical arrangement to convert the linear motion of the slider 23 to an angular motion of the linkages 22, resulting in a translation of the fingers 21. Links 22A of the four-bar linkages 22 have an extension at the end of which pin 22B or like follower is present, to be part of the mechanism 25. Links 22A may have a V-shape as illustrated, but other shapes are possible. Another possible configuration for the mechanism 25 is to have a rack on the translating component 23, and pinion(s) rotating with a link of the four-bar linkage 22. In another variant, the fingers are the links 22A (there are no four-bar linkages 22). In such a variant, the fingers 22A would rotate toward a grasping position. These are merely configurations among others, as there may be more fingers, or a different type of end effector. In a variant, while there may be two or more fingers 21, a single one of the fingers 21 while the other(s) is(are) stationary. However, the actuator mechanism of the present disclosure pertains to the linear motion at the end effector. The configuration of Fig.3, with the parallelogram four-bar linkages 22, may constrain the fingers 21 to a translational movement. The fingers 22 may thus be said to have a constant orientation relative to the wrist 24. Moreover, as observed in Fig.3, the tips 21A of the fingers 21 each have an inward surface, with the inward surfaces of the tips 21A being parallel to one another and meeting at a common plane. This is merely optional. Other configurations for the finger assemblies include living hinges.
[0062] The vacuum suction cup 26 may optionally be mounted at the extremity of the slider 23. This slider 23 may be a hollow shaft, making it possible to convey the vacuum to the suction cup 26 through it. This is optional as there may not be any suction capability at the gripper 20. When the ¿ngers 21 are closed, the cup 26, if present, sits in the palm of the gripper 20. When the fingers 21 open, the cup 26 exceeds the extremity of the ¿ngertips to be able to grasp an item.
[0063] To actuate the linear slider 23, an actuator mechanism 30 in accordance with the present disclosure may be used, as shown in Fig.4. The actuator mechanism 30 may have a translational joint having a rod displaceable in translation. The translational joint may be a prismatic joint or a cylindrical joint (e.g., with inactive rotation). In a variant, the rod is the slider 23, and may optionally be hollow. Other expressions may be used for 23, such as shaft, link, or any other like member. The rod 23 is operatively connected to the gripper 20 such that the translation causes a grasping action, as detailed with reference to Fig.3. The grasping action may includemovement toward and away from a grasp. The translation joint may also include the tubular body of the end effector 12 (e.g., wrist 24), which tubular body may rotate on itself, i.e., along a central axis of its tubular body.
[0064] The actuator mechanism 30 may also have a link 31 pivotally connected at a first end thereof to the link 14 by a first revolute joint 31A (though other joints could be used). The link 31 is pivotally connected at a second end thereof to the rod 23 by a second revolute joint 31B (though other joints could be used). The second revolute joint 31B may for example include a yoke and a crosspiece (shown as a rod). Thus a rotational movement of the link 14 about the revolute joint 14A is converted to a translation of the rod 23, via the link 31. Thus, changing the prescribed angle Ȗ (Fig.1) changes the elevation of the linear slider or rod 23, thus opening and closing the ¿ngers 21.
[0065] The actuator mechanism 30 may be described as a crank-slider mechanism, as the link 14 may act as a crank for the slider 23. This architecture is such that the parallel robot 10 is operable to selectively displace the gripper 20 in three translational degrees of freedom (DOF), the parallel robot 10 using the leg 15 for imparting unlimited revolutions in one rotational DOF to the gripper 20. In an embodiment, directions of movement of the link 31 and of the rod 23 lie in a plane of movement. The axes of the first revolute joint 31A and of the second revolute joint 31B are normal to the plane of movement.
[0066] To operate the gripper 20, the relationship between its opening d and the vertical motion u of its linear slider 23 is found. Fig.5 shows the geometric model of one of the ¿ngers 21 of the gripper 20. Closed (left) and open (right) con¿gurations are depicted to illustrate the motion. A controller 40 (Fig.7) may be present to operate the actuators in the R joints and hence control the movements of the end effector 12. The controller 40 may include one or more processing units 41, and a non-transitory computer-readable memory 42 communicatively coupled to the processing unit and comprising computer-readable program instructions executable by the processing unit 41. The controller 40 may also be present in the other variants of the parallel robot 10 shown herein. The computer-readable program instructions may be based on the kinematic modeling described below.
[0067] The constraint equations can be written aswhere exand eyare the position coordinates of the pivot at point E, l3is the length of the input link of the gripper 20 and ^ is the input angle of this link, andwhere l4is the length of one link of the parallelogram 22, ^ is the (constant) angle between the input link and the parallelogram link and l5is the horizontal offset of the end link. From (20), one can writewhile (21), can be rewritten as
[0068] Then, (22) is substituted into (23), and after solving for cos^, one obtainswhere
[0069] Next, (22) and (24) are substituted into the following trigonometric identityto yield where
[0070] Equation (29) is the fundamental relationship between the input u and the output d of the gripper 20. To solve the direct kinematic problem of the gripper 20, the input u is prescribed and (29) is solved for d, which leads to which is a quadratic equation yielding at most two solutions.
[0071] To solve the inverse kinematic problem, the gripper opening d is prescribed and (29) is then solved for u, which leads to
[0072] In order to obtain the Jacobian of the gripper (velocity relationship), (29) is differentiated with respect to time, yielding, after some manipulations
[0073] Fig.6 shows the geometric representation of the crank-slider mechanism used to induce a linear displacement u on the slider through the angular motion of the redundant link. To complete the kinematic equations needed to operate the gripper 21 using the redundancy of the robot 10, the relationship between the redundant link’s angle Ȗ and the vertical motion u of the slider is found. From the law of cosines, one can get
[0074] Solving for cos Ȗ, the inverse kinematics of the gripper 20 is obtained, which is the angle Ȗ corresponding to a prescribed vertical displacement u, namely whereandwhere h0stands for the maximum extension of the slider 23, in the con¿guration where the gripper 20 is closed. Globally, it is therefore possible to compute the angle of the redundant link that is required to obtain a given opening, d, of the gripper 20. To this end, (37) is ¿rst used to compute the value of u for a prescribed value of d. Then, (41) is used to compute h and ¿nally (40) is used to compute angle Ȗ.
[0075] Even though the gripper’s design is relatively simple, optimising its geometry may be complex because of the number of parameters, namely (li(i=1,...,5),ex,ey,^^,h0). The purpose of this optimisation is to achieve a larger gripping force at the ¿ngertips while reducing the required torque at the actuated joints.
[0076] To do so, the principle of virtual work is used to evaluate the required torques IJ =[IJ1,...,IJ5]Tat the motors for a given end-effector force, noted where f is the force at the end effector and IJijand IJȖare the torque associated with the corresponding angles. Thus, it is possible to quantify the impact of each of the parameters on the gripping force. The principle of virtual work can be written as
[0077] In order to use equation (45), the Jacobian matrices of the parallel robot 10 need to be updated with the relationship between the speed of opening d of the gripper 20 and the angular velocity Ȗ of the redundant link.
[0078] To this end, equation (40) is differentiated with respect to time and the following relation is obtainedwhere
[0079] Because ^^ =^,^equation (38) can be used to replace^^by ^^ in equation(46). One obtainswhere
[0080] The Jacobian of the gripper 20 (49) can now be substitued into the Jacobian Matrices J (4) and K (5) so that the 5th component of the Cartesian velocityvector ^^ is now^^instead of ^^ , becoming
[0081] With the new Jacobian matrices, the principle of virtual work can now be used to compute the torque at the actuators for a given grasping force. The link lengths and angles have thus been iteratively modi¿ed until the torques needed to apply a 10N force at the ¿ngertips (with the TCP in the centre of the workspace) was reduced to an acceptable value. The maximum opening of the gripper 20 has been reduced from 115 mm to 85 mm as a compromise.
[0082] In order to demonstrate the capabilities of a low-impedance backdrivable robot using the redundant parallel architecture of Fig.1, a prototype is shown in Fig.7. For the ¿ve actuated joints, Yaskawa SGMCS-10C3C11 Direct Drive motors are used, since their rotors have no cogging and no gear reduction. These features suit the needs for low-impedance pHRI. Using the principle of virtual work, analyses were conducted to estimate the torques needed to lift a 2kg payload at the centre of the workspace with a grasping force of 20N. Thus, 10Nm rated torque motors were selected to satisfy this need.
[0083] The dimensions of the proximal and distal links were selected so that the workspace of the parallel robot 10 can match the wide movements of a fully extended human arm. Also, the motors are aligned and stacked on one another to reduce the footprint of the robot while enlarging its workspace. Fig.8 shows the model of the parallel robot 10 on which the workspace is superimposed.
[0084] Fig.9 and Fig.10 present the experimental results obtained with the parallel robot 10 for this trajectory. In Fig.9, the actuated joint coordinates are ¿rst shown, followed by the joint errors, as well as the motor torques. The Cartesian position and speed are then presented in Fig. 10. The maximum acceleration prescribed to the parallel robot 10 during this trajectory is 1.76g, where g stands for the gravitational acceleration and the maximum speed of 2.5 m / s is calculated from the joint positions.
[0085] The payload of the parallel robot 10 can be increased by adding a counterweight on the upper proximal link, but this is at the expense of increasing the inertia of the robot 10 along the vertical direction (along the y axis).
[0086] To con¿rm the low-impedance mechanical backdrivabilty of the parallel robot 10, an oscillatory motion is performed at the end effector along axes x and z with the robot in a collaborative mode. A force sensor is mounted at the end effector (as depicted in Fig.11) in order to measure the required force from the user to produce the oscillatory motion. The results are illustrated in Fig.12 and Fig.13. In the ¿rst scenario, an oscillatory motion was imparted with the maximum speed possible from the user to demonstrate the high-backdrivabilty bandwidth of the parallel robot 10, which showed to be around 2Hz. In the second scenario, a 1Hz oscillatory motion was applied on the end effector to show the low force needed to displace the gripper 20. The results show that with a peak force of 12N, a 0.75m / s velocity can be applied on the end effector. These results are comparable to the backdrivability of a very low- impedance 5-DOF serial robot manipulated with a 3-DOF displacement sensor.
[0087] Finally, to prove that the parallel robot 10 is safe for pHRI, a collision detection was implemented. To do so, a threshold is put on the difference between the actual articular positions and the prescribed articular positions. If exceeded, the target position becomes the actual position, preventing any further movements from the robot. Experiments show that a 20N force is needed to trigger an instantaneous emergency stop.
[0088] Thus, the parallel robot 10 can be described as being a (4+1)-DOF collaborative parallel robot with a low-impedance backdrivabilty and a remotely operated built-in gripper 20. Unlimited rotation of the gripper 20 is achieved in a large workspace and the kinematic redundancy is used to operate the gripper at the end- effector, by way of actuator mechanism 30. The robot 10 may thus achieve high speedand acceleration performances whilst having a great payload capability. The low- impedance mechanical backdrivabilty is proved through experiments, as well as the high physical interaction bandwidth, which greatly exceeds that of conventional cobots. Finally, the robot 10 may be safe for pHRI through its ability to perform an emergency stop following a collision.
[0089] The robot 10 may generally be described as having a gripper having at least a pair of fingers movable relative to one another in a grasping action; a parallel mechanism having an end effector operatively supporting the gripper, the parallel mechanism being operable to selectively displace the gripper in three translational degrees of freedom (DOF), the parallel mechanism having a leg for imparting rotational movement to the end effector; and an actuator mechanism to actuate the gripper in the grasping action, the actuator mechanism including a member displaceable in translation relative to the end effector, the member operatively connected to the gripper such that the translation causes the grasping action, a link pivotally connected at a first end thereof to the leg by a first joint having at least one rotational degree of freedom, the link pivotally connected at a second end thereof to the member by a second joint having at least one rotational degree of freedom, whereby a rotational actuation of the leg is convertable to said translation via the link.
[0090] The above description is meant to be exemplary only, and one skilled in the art will recognize that changes may be made to the embodiments described without departing from the scope of the invention disclosed. Still other modifications which fall within the scope of the present invention will be apparent to those skilled in the art, in light of a review of this disclosure, and such modifications are intended to fall within the appended claims.
Claims
CLAIMS 1. A robot comprising: a gripper having at least a pair of fingers movable relative to one another in a grasping action; a parallel mechanism having an end effector operatively supporting the gripper, the parallel mechanism being operable to selectively displace the gripper in three translational degrees of freedom (DOF), the parallel mechanism having a leg for imparting rotational movement to the end effector; and an actuator mechanism to actuate the gripper in the grasping action, the actuator mechanism including a member displaceable in translation relative to the end effector, the member operatively connected to the gripper such that the translation causes the grasping action, a link pivotally connected at a first end thereof to the leg by a first joint having at least one rotational degree of freedom, the link pivotally connected at a second end thereof to the member by a second joint having at least one rotational degree of freedom, whereby a rotational actuation of the leg is convertable to said translation via the link.
2. The robot according to claim 1, including a pin-in-slot mechanism between the member and the fingers.
3. The robot according to claim 1, wherein the fingers are connected to the end effector by four-bar linkages.
4. The robot according to claim 3, wherein the four-bar linkages are parallelogram four-bar mechanisms.
5. The robot according to claim 3 or claim 4, wherein a link of each of the four- bar linkage is operatively connected to the member for causing the grasping action from the translation of the member.
6. The robot according to claim 5, wherein the link of each of the four-bar linkage is connected to the member by a pin-in-slot mechanism7. The robot according to claim 6, including a pin at the end of the link of each of the four-bar linkage for forming the pin-in-slot mechanism.
8. The robot according to any one of claims 3 to 7, wherein the fingers move in a constant orientation relative to the end effector.
9. The robot according to any one of claims 3 to 8, wherein the fingers each have a distal inward surface.
10. The robot according to claim 9, having two of the fingers, and wherein the distal inward surfaces of the fingers are parallel to one another.
11. The robot according to any one of claims 1 to 10, wherein the member defines a suction passage therethough, and further including a suction cup at the distal end of the member, between the pair of fingers, the suction cup being in fluid communication with the suction passage.
12. The robot according to claim 11, wherein the member is tubular, the suction passage being defined by an inner cavity of the member.
13. The robot according to any one of claims 1 to 12, wherein the end effector is unconstrained in one rotational degree of freedom, such that the leg imparts unlimited revolutions to the end effector.
14. The robot according to any one of claims 1 to 13, wherein the first joint is a revolute joint.
15. The robot according to any one of claims 1 to 14, wherein the second joint is a revolute joint.
16. The robot according to any one of claims 1 to 15, wherein the parallel mechanism constrains the end effector to movement in three translational degrees of freedom and one rotational degree of freedom.
17. The robot according to claim 16, including five actuators.
18. The robot according to any one of claims 16 to 17, wherein one of the five actuators is for the leg and is on a base.
19. The robot according to claim 18, wherein all of the five actuators, except for the one actuator for the leg, are rotational actuators having rotational axes parallel to one another.
20. The robot according to claim 19, wherein the rotational axes are colinear.
Citation Information
Patent Citations
Device for handling articles
EP2799190A2
Light weight object gripping device for parallel type manipulator robot, has robot gripper with grip jaws detachably mounted on support levers by screw, and motor controlled by variator with program to detect objects` presence between jaws
FR2877867A1
Robotic end effectors for use with robotic manipulators
US10265862B1
Parallel robot
US20060245894A1
Three-degree-of-freedom parallel planar manipulator
US6339969B1
